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LỜI NÓI ĐẦU 


Trong sự nghiệp công nghiệp hoá, hiện đại hoá đất nước ván đề 
tự động hoá sản xuất có vai trò đặc biệt quan trọng, 


Mục tiêu ứng dụng kỹ thuật robot Irong công nghiệp là nhằm 
náàng cao năng suất dây chuyển công nghề. nâng cao chất lượng và khủ 
năng cạnh tranh của sản phẩm, đồng thời cái thiện điển kiện lao dộng. 
Sự cạnh tranh hàng hoá đặt ra mội ván đề thời sự là làm xao để hệ 
thống tư động hoá vấn xuất phái có tính lnh hoại cao nhằm đáp ứng với 
sự biển động thường xuyên của thị trường hàng hoá cạnh tranh. Robol 
công nghiệp là bộ phận cấu thành khóng thể thiếu nong việc tạo ra 
những hệ thống tự động xen xuất lĩnh hoạt đó. 


Cần nữa thể kỷ có mặt trong văn xu, robot công nghiệp đỡ có 
một lịch sử phát triển hấp dân. Ngày nay robot công nghiệp được dùng 
rồng rãi ở nhiêu lĩnh vực sản xuất. Điều đó xuất phát từ những tru điềm 
cơ bím của các loại robot dã được chọn lựa và dục kết lại qua bao 
nhe năm ứng ẢNHG Ở nhiỄH nước. 


Ở giai đoạn trước những năm 1990 hấu nhữ trong nước ta hoàn 
ruàn chưa du nhập về kỹ thuật robot, thậm chí còn chưa nhận được 
nhiều thông tín kỹ thuải về lĩnh vực này. Từ nănt 1990 nhiều €Ơ sơ công 
ngiItệp dã bắt đầu nhập ngoạt nhiều loại robot phục vụ các việc như 
tháo lấp dụng cụ cho các ung tâm gia công ƠNC, lắp rấp các lình 
kiện điện tư, thao tác ở các máy ép nhựa, hàn vỏ xe Ôtô, xe máy và phun 
phú bê mặt v.v... Có những nơi đã bất đâu thiết kế, chế tạo và tắp ráp 
robot. 


Ở nhiều trường dại học, cao đẳng và dạyv nghề kỹ thuật cao đã 
bát đâu giảng dạy về robot công nghiệp. Đại biệt rong những nằm gân 
đây nhiều nơi đã mi ngành đào tạo về cơ-tin-diện tứ (Mechatronicas) và 
rát quan tâm đến robol công nghiệp. “Cơ - ún - điện tử” và “Robot công 
nghiệp" là 2 lĩnh vực khoa học kỹ thuật cao rất gắn bó với nhau. Ø 
nhiều nước chúng kết hợp với nhan trong mỘi ngành đào tạo. Trong 
*®Robot công nghiệp” có hấu hết các vấn đề của “Cơ - tin - điện từ” và 
đồng thời sự phát triển của “Cơ - tn - điện từ” cũng đều phản ảnh 
trong kỹ thuật robol. 


Cuốn sách này là giáo trình giảng dạy về robot công nghiệp tại 
trường Đại học Bách khoa (ĐHBK) - Hà Nội. Trong đó xẽ củng cấp 
tương đối toàn diện các kiến thức cơ sở và nâng cao về robot công 
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nghiệp. Phân kiến thức cơ sở chúng tôi đã cố gắng viết dễ hiểu cho nhiều 
đối tượng bạn đọc. Đông thời cũng bổ sung, cập nhật và phân tích nhiều 
thông ríh, kết quả nghiên cứu hiện đại ở trong và ngoài nước. Sách được 
dùng làm tài liệu giảng dạy học tập cho giáo viên, sinh viên các HHỜng 
đại học, cao đẳng va dạy nghề kỹ thuật cao. Đồng thời cũng là tài liệu 
tham khảo cho cần bộ nghiên cứu về lĩnh vực này và các cán bộ điều 
hành sản xuất ở nhiều ngành công nghiệp khác nhau. Trong lân in thứ 
hai chừng tôi bổ sung một số hình ảnh về các robocar được chế tạo Irong 
nước vào cuỗi chương Ï và thêm một chương mới “Động học robot khi di 
chuyển nhỏ ”. 


Trong lần ¡in thứ ba này chúng tôi chỉ chỉnh sửa nhỏ ở một số chỗ. 


Chúng tói rất mong và cảm ơn sự đóng sóp ý kiến của bạn đọc. 
Các ý kiển xin gửi về Nhà xuất bản Khoa học và Kỹ thuật, 70 Trần Hưng 
Đạo - Hà Nội. 


Tác giả 


CHƯƠNG I 


GIỚI THIỆU CHƯNG VỀ ROBOT CÔNG NGHIỆP 


1.1. SỰ RA ĐỜI CỦA ROBOT CÔNG NGHIỆP. 


Nhụ cầu nâng cao năng suất và chất lượng sản phẩm ngày càng 
đồi hỏi ứng dụng rộng rãi các phương tiện tự động hoá sản xuất. Xu 
hướng tạo ra những đây chuyền về thiết bị tự động có tính linh hoạt cao 
đang hình thành. Các thiết bị này đang thay thế đần các máy tự động 
"cứng" chỉ đáp ứng một việc nhất định trong lúc thị trường luôn luôn đời 
hỏi thay đổi mặt hàng về chủng loại. về kích cỡ và về tính năng v.v.... Vì 
thế ngày càng tăng nhanh nhu cầu ứng dụng robot để tạo ra các hệ thống 
sản xuất tự động lính hoại. 


Thuật ngữ "robot" lần đầu tiên xuất hiện năm 1922 trong tác 
phẩm “Rossums Universal Robot" của Karel Capek. Theo tiếng Séc thì 
robot là người làm tạp dịch. Trong tác phẩm này nhân vật Rossum và con 
trai của ông đã tạo ra nhữnp chiếc máy gần giống như con người để hầu 
hạ con người. 


Hơn 20 năm sau, ước mơ viễn tưởng của Kerel Capek đã bất đầu 
hiện thực. Ngay sau chiến tranh thế giới lần thứ 2, ở Hoa Kì đã xuất hiện 
những tay máy chép hình điều khiển từ xa trong các phòng thí nghiệm về 
vật hệu phóng Xa. 


Vào piữa những năm 50 bên cạnh các tay máy chép hình cơ khí 
đó. đã xuất biên các loại tay máy chén hình thuỷ lực và điện từ, như tay 
máy Minotaur I hoặc tay máy Handyman của General Electric. Năm 
1954 George C. Devol đã thiết kế một thiết bị có tên là "Cơ cấu bán lẻ 
dùng để chuyển hàng thco chương trình”. Đến năm 1956 Devol cùng với 
Joscph F. Engelber, một Kĩ sư trẻ cua công nghiệp hàng không, đã tạo ra 
loại robot công nghiệp đầu iiển năm 1959 ở Công ty Unimation. Chỉ đến 
năm 1975 Công 1y Unim+tion mới bắt đầu có lợi nhuận từ sản phẩm robot 
đầu tiên này. 


Chiếc robot công nghiệp được đưa vào ứng dụng đầu tiên, năm 
I9ố1, ở một nhà máy ô tô của General Motors tại Trenton. New Jerscy 
Hoa Kỳ. 


Năm 1967 Nhật Bản mới nhập chiếc robot công nghiệp đầu tiên từ 
Công ty AME của Hoa Kỳ (Amernican Machine and Foundry Company). 
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Đến năm 1990 có hơn 40 công ty Nhật Bản, trong đó có những công ty 
khổng lồ như Công ty Hitachi và Công ty Mitsubishi. đã đưa ra thị trường 
quốc tế nhiều loại robot nổi tiếng. 


Từ những năm 7Ó việc nghiên cứu năng cao tính nâng của robot 
đã chú ý nhiền đến sự lắp đặt thêm các cảm biến ngoại tín hiệu để nhận 
biết môi trường làm việc. Tại trường Đại học Tổng hợp Stanford người tà 
đã tạo ra loại robot lắp ráp tự động điều khiển bằng máy vi tính trên cơ sở 
xư lý thông tin từ các cảm biến lực và thị giác. Vào thời gian này Công ty 
IBM đã chế tạo loại robot có các cảm biến xúc giác và cảm biến lực, điều 
khiển bằng máy tính để lắp ráp các máy In gồm 20 cụm chỉ tiết. 


Vào giai đoạn này ở nhiều nước khác cũng tiến hành các công 
trình nghiên cứu tương tự, tạo ra các loại robot điều khiển bằng máy vì 
tính, có lắp đạt các thiết bị cảm biến và thiết bị giao tiếp người - máy. 


Một lĩnh vực được nhiều phòng thí nghiệm quan tâm là robot tự 
hành. Các còng trình nghiên cứu tạo ra robot tự hành theo hướng bắt 
chước chân người hoặc súc vải. Các robot này còn chưa có nhiều ứng 
dụng trone công nghiệp. Tuy nhiên các loại xe robot (robocar) lại nhanh 
chóng được đưa vào hoạt động trong các hệ thống sản xuất tự động linh 
hoạt. 


Từ những năm 80, nhất là vào những năm 90. đo áp dụng rộng rãi 
các tiến bộ kỹ thuật về vi xử lý và công nghệ thông tín, số lượng robot 
công nghiệp đã gia tăng, giá thành đã giảm đi rõ rệt, tính năng đã có 
nhiều bước tiến vượt bậc. Nhờ vậy robot công nghiệp đã có vị trí quan 
trọng trong các dây chuyển tự động sản xuất hiện đại. 


Ngày nay chuyên ngành khoa học về robot "robotics” đã trở thành 
một lĩnh vực rộng trong khoa học, bao gồm các vấn đề cấu trúc cơ cấu 
động học, động lực học, lập trình quỹ đạo, cảm biến tín hiệu, điều khiển 
chuyển động v.v... Các vấn đề này sẽ lần lượt được đẻ cập đến trong các 
chương của giáo trình này. 


Trước khi bước vào nehiẻn cứu các nội dung này chúng ta cũng, 
cần thống nhất về thuật ngữ “robot công nghiệp” (Industrial robot). Trong 
nhiều tài liệu khác nhau, định nphĩa về robot công nghiệp cũng khác 
nhau. Khi "robot công nghiệp” đầu tiên ra đời, Công ty AMEF đã quảng 
cáo nó là một loại máy tự động vạn năng. Trong Từ điển Webster định 
nghĩa robot là những máy tự động có thể thực hiện được một số chức 
năng của con người. Nhưng nếu vậy thì có nhiều loại máy khác nhau 
cũng có thể gọi là robot. Viên Kỹ thuật robot của Hoa Kì định nghĩa 
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robot là loại tay máy nhiều chức năng, với chương trình làm việc thay 
đổi dược, đùng để. thực hiện một số thao tác sản xuài. Có nhiều tài liệu 
khí định nghĩa robot rất lưu ý đến tiêu chí điều khiển bằng máy tính. 
Nhưng trong phân loại robot công nghiệp theo tiêu chuẩn của Nhật Bản 
(IS B0134 - 1979) có cả nhóm tay máy điều khiển bằng tay. 


Theo TSO (International Standards Ôrpanizattlon) thì: "robot công 
nphiệp là một tay máy đa mục tiêu, có một số bậc tự đo. để đàng lập 
trình. điều khiến trợ động. dùng để tháo lắp phôi, dụng cụ hoặc các vật 
dụng khác. Do chương trình thao tác có thể thay đối nên thực hiện nhiều 
nhiệm vụ đa dạng”. Tuy nhiên, robot công nghiệp được định nghĩa như 
thế chưa hoàn toàn thoả đáng. 


Robot công nghiệp có thể dược hiểu là những thiết bị tư động lĩnh 
hoạt, bắt chước được các chức năng lao động c2ng nghiệp của con người. 
Nói đến thiết bị tự động linh hoạt là nhấn mạnh đến khả năng thao tác với 
nhiều bậc tự do, được điều khiển trợ động và lập trình thay đổi được. Còn 
nói đến sự bát chước các chức năng lao động công nghiệp của con người 
là có ý nói đến sự không hạn chế từ các chức năng lao động chân tay đơn 
giản đến trí khôn nhân tạo, tùy theo loại hình công việc lao động cần đến 
chức nãng đó hay không. Đồng thời cũng nói đến mức độ cần thiết bất 
chước được như con người hay không. 


1.2 TÌNH HÌNH PHÁT TRIỂN ROBOT CÔNG NGHIỆP. 


Gần nửa thế kỷ có mặt tronp sản xuât, robot công nghiệp đã có 
một lịch sử phát triển hấp dân. Ngày nay đã có nhiều tài liệu phô thông 
viết về tổng quan qúa trình phát triển này. Vì thế ở đây chỉ: nêu tóm tắt 
một số liệu minh họa bằng các biểu đỏ về tình hình phát triển của robot 
công nghiệp. 


Trên hình 1.1. là biểu đồ về tình hình ứng dụng robot công nghiệp 
Ở các nước. 
Trên hình 1.2 là biểu đồ về chỉ số sử dụng robot ở các nước và ở 


trong ngành công nghiệp ö tô, biểu thị qua số lượng robot trên l vạn cóng 
nhân. 


Hình 1.3 là biểu đồ về thị trường robot năm 2001. 


Các số liệu ở các biểu đồ lấy theo các tài liệu của Liên đoàn quốc 
tế Về robot (International Federation of Robotics). 


Đối với (A) 


(Ch&) 


Đối với (B, C, D, E, F) 


41991 1992 1993 1994 1995 1996 1997 1998 1999 2000 


Hình 1.1L, Tình hình ứng dụng robot công nghiệp ở các nước 

(A) Các nước: Pháp, Đức, Italia, Nhật, Anh, Mũ 
(B) Châu đ: úc, Hàn Quốc. Singapore, Đài Loạn 
(C) Tâu Âu: Áo, Đan Mạch, Phần Lan, Nauy, Tây Ban Nha, 

Thuy Điển, Thuụ Sĩ 
(D) Đông Âu: Séc, Hungari, Ba Lan, Slouakia, Siouenia 
(E) Các nước SNG 
(F) Các nước khúc. 
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Hình 1.2 - Biêu đồ uề chí số sử dụng robot 
(số lượng robot trên Ú vạn cóng nhận ở môi nước) 


: Nhật Bản II 19 
Hàn Quốc 92 


Anh 92 


U.S.A 888 


Các nước khác Đức 570 
518 


Hình 1.3. 7Ù; trường robot năm 2001 


Về hiệu qua sử dụng iobot thì ở đây chỉ đưa ra một vài ví dụ ở 
hai nhà máy thuộc Tập đoàn Chế tạo máy Fuji của Nhật Bán. 


Hình 1.4 mình họa các số liệu thống kẻ: nếu dùng máy công cụ 
thông thường thì mỗi công nhân đứng I máy; với máy điều khiển chương 
trình thì một công nhân đứng 2 máy; còn đối với modun sản xuất linh 
hoạt đùng robot thì một công nhân có thể trông coi 10 modun. 


Số liệu sau đây của Tập đoàn Fuji đã minh họa về ảnh hưởng của 
việc ứng dụng robot ở nhà máy sản xuất động cơ. J2o tầng cường trang bị 
thèm robot từ 32 chiếc lên LÔI chiếc, nên số công nhân giảm từ 108 
xuông còn 60 người, nhưng sản lượng động cơ hàng tháng lại tăng lên từ 
6000 chiếc lén đến 10.000 chiếc. 


Máy thông thường 
(1 công nhân-Ìmáy) 
=“ + : 4 
Máy điểu khiển. jh 
chương trình | | 
(1 cêng nhằn-2máy) | \ — 
L_ co 
T K 
Modun sản xuất [ —n II. 
linh hoại | 
(1 công nhân-10 1 ¬ : 
modun)[Ƒ—— —v 
] | 1 L == : } .- 1} 
bà = d—~ . 


Hình 1.4. Mỏ phỏng hiệu qua sử dụng robot ở Nhà máu Chế tạo robot Fuji 
(Nhật Bản). 

Các nguyên nhân chủ yếu thúc đẩy tốc độ robot hoá và lính hoạt 
hệ thống sản xuất hiện đại là: 
: - Sự ảnh hưởng của các tiến bộ kỹ thuật về cơ - tin - điện tử 
(mechbatronIcs). 

- Tốc độ giảm giá nhanh của hàng vị điện tử. 

- Tốc độ tăng chỉ phí cho người lao động. 

Múc chị phí cho người lao động trung bình tăng 6% hàng năm so 
với mức giảm giá các máy tính lopc trung bình giảm 25% hàng năm. 


1.3. ỨNG DỰNG ROBOT CÔNG NGHIỆP. 
1.3.1 Mục tiêu ứng dụng robot công nghiệp. 


Mục tiêu ứng dụng robot công nghiệp nhám póp phần nàng cao 
nâng suất đây chuyền công nghệ, giảm giá thành, nâng cao chất lượng và 
khá năng cạnh tranh của sản phẩm, đồng thời cải thiện điều Kiện lao 
động. Điều đó xuất phát từ những ưu diểm cơ bản của robot, đã đúc kết 
lại qua bao nhiêu năm được ứng dụng ở nhiều nước. Những ưu điểm có 
bạn đó là: 


l). Robot có thể thực hiện được một quy trình thao tác hợp lý 
bằng hoặc hơn người thợ lành nghề một cách ổn định trong suốt thời gian 
làm việc. Vì thế robot có thể góp phản nâng cao chất lượng và khả năng 
cạnh tranh của sản phẩm. Hơn thế. robot còn có thể nhanh chóng thay đổi 
còng việc để thích nghị với sự biến đổi mâu mã, kích cỡ sản phẩm theo 
yêu cầu của thị trường cạnh tranh. 


2) Khả năng giảm giá thành sản phẩm do ứng dụng robot là vì 
giảm được đáng kể chỉ phí cho người lao động, nhất là ở các nước có mức 
cao về tiền lương lao động, cộng các khoản phụ cấp và bảo hiểm xã hội. 
Theo số liệu của Nhật Bản thì nếu ! robot làm việc thay thể cho một 
người thợ thì tiền mua robot chỉ bằng tiên chí phí cho người thợ trong 
vòng 3 đến 5 năm, tuỳ theo robot làm việc mấy ca. Còn ở Hoa Kì. trunp 
bình trong 1 giờ làm việc robot có thể đem lại tiền lời là 13USD. Ở nước 
ta những năm gần đây ở nhiều doanh nghiệp, khoản chỉ phí lương bồng 
cũng chiếm tý lệ cao trong giá thành sản phẩm 


3) Việc áp dụng robot có thể làm táng năng suất dây chuyền công 
nghệ. Sở đĩ như vậy vì nếu tăng nhịp độ khẩn trương của dây chuyền sản 
xuất. nếu không thay thế con người bằng robot thì người thợ không thể 
theo kịp hoặc rất chóng mệt mỏi. Theo số liệu của Hãng Fanuc, Nhật 
Bản. tÌì năng suất có KÌn tăng lên đến 3 lần. 


4) Ứng dụng robot có thể cải thiện điều kiện lao động. Đó là ưn 
điểm nổi bật nhất mà chúng ta cần lưu tâm. Trong thực tế sản xuất có rất 
nhiều nơi người lao động phải làm việc suốt buổi trong môi trường rất bụi 
bặm, ẩm ướt, nóng nực hoặc ồn ào quá nức cho phép nhiều lần. Thậm chí 
ở nhiều nơi người lao động còn phái làm việc vớt môi trường độc hại 
nguy hiểm đến sức khoẻ con người, dễ bị cụt chân tay, dễ bị nhiễm hoá 
chất độc hại, nhiễm sóng điện từ và phóng xạ v.v... 


1.3.2 Các bước ứng dụng robot. 


Việc ưu tiên đầu tư trước hết phải nhằm để đồng bộ hoá cả hệ 
thống thiết bị, rồi tự động hoá và robot hoá chúng khi cần thiết. Để quyết 
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định đầu tư cho việc robot hoá cho cả đây chuyền công nghệ hoặc chỉ ở - 
một vài công đoạn, người ta thường xem xXết các mặt sau: 


1) Nghiên cứu quá trình công nghệ được robot hoá và phân tích 
toàn bộ hệ thống sản xuất của xí nghiệp. 


Trong bước này cần xét đến đầy đủ các chi phí và nếu hiệu quả 
tính ra cho toàn bộ hệ thống không thể hiện rõ thì việc đầu tư robot hoá là 
chưa nên. 


2) Xác định các đối tượng cần robot hoá. 


Khi xác định nên thay thế robot ở những nguyên công nào thì phải 
xem xét khả năng liệu robot có thay thế được không và có hiệu quả hơn 
không. Thông thường người ta ưu tiên ở những chỗ làm việc quá nặng 
nhọc, bụi bạm, ồn ào, độc hại, căng thẳng hoặc quá đơn điệu. Xu hướng 
thay thế hoàn toàn bằng robot thực tế không hiệu quả bằng việc giữ lại 
một số công đoạn mà đòi hỏi sự khéo léo của con người. 


3) Xây dựng mô hình quá trình sản xuất đã được robot hóa. 


Sau khi xác định được sơ đồ tổng thể quá trình công nghệ, cân xác 
định rõ dòng chuyển dịch nguyên liệu và dòng thành phẩm để đảm bảo sự 
nhịp nhàng đồng bộ của toàn hệ thống. Có thế mới phát huy được hiệu 
quả đầu tư vốn. 


4) Chọn lựa mẫu robot thích hợp hoặc chế tạo robot chuyên dùng. 

Đây là bước quan trong, vì robot có rất nhiều loạt với giá tiền rất 
khác nhau, nếu không chọn đúng thì có thể không những đầu tư quá đắt 
mà còn không phát huy được, như kiểu dùng người không đúng chỗ, việc 
này thường xảy ra khi mua robot của nước ngoài. Có những chức năng 
của robot được trang bị nhưng không cần dùng cho công việc cụ thể mà 
nó đảm nhiệm trên dây chuyền sản xuất. Vì thế mà đội giá lên rất cao, chì 
có lợi cho rơi cung cấp thiết bị. 


Cấu trúc robot hợp lí nhất. là cấu trúc theo modun hoá. Như thế có 
thể hạ giá thành sản xuất, đồng thời đáp ứng được như cầu phục vụ công 
việc đa dạng. Cấu trúc càng đơn giản càng dễ thực hiện độ chính xác cao 
và hạ giá thành. Ngoài ra lại còn có tự tạo dựng các robot thích hợp với 
công việc trên cơ sở mua lắp các modun chuẩn hoá. Đó là hướng triển 
khai hợp lí đối với đạt bộ phận xí nghiệp trong nước hiện nay cũng như 
trong tương lai, 


1.3.3 Các lĩnh vực ứng dụng robot cóng nghiệp. 


L) Một trơng các lĩnh vực đó là Ki nghệ đúc. Thường trong phân 
xưởng đúc công việc rất đa dạng, điều kiện làm việc nóng bức, bụi bặm, 
rnặt hàng thay đổi luôn và chất lượng vật đúc phụ thuộc nhiều vào quá 
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trình thao tác. Việc tự động hoá toàn phần hoặc từng phần quá trình đúc 
bằng các dây chuyền tự động thông thường với các máy tự động chuyên 
dụng đòi hỏi phải có các thiết bị phức tạp, đầu tư khá lớn. Ngày nay ở 
nhiều nước trên thế giới robot được dùng rộng rãi để tự động hoá công 
nghê đúc, nhưng chủ yếu là để phục vụ các máy đúc áp lực Robot có thể 
làm nhiều việc như rót kim loạt nóng chảy vào khuôn, lấy vật đúc ra khỏi 
khuôn, cắt mép rhừa, làm sạch vật đúc hoặc làm tăng bên vật đúc băng 
cách phun cát v,v... Dùng robot phục vụ các máy đúc áp lực có nhiều ưu 
điểm. Ví dụ, đảm bảo ổn định chế độ làm việc; chuẩn hoá về thời gian 
thao tác, về nhiệt độ và điều kiện tháo vật đúc ra khỏi khuôn ép. Bởi thế, 
chất lượng vật đúc tăng lên. 


2) Trong ngành gia công ấp lực điều kiện làm việc cũng khá năng 
nẻ, để pây mệt mỗi nhất là ở trong các phân xưởng rèn đập nên đòi hỏi 
sớm áp dụng robot công nghiệp. Trong phân xưởng rèn robot có thể thực 
hiện nhiều việc, ví dụ như đưa phôi thừa vào lò nung, lấy phôi đã nung 
nóng ra khỏi lò, mang nó đến máy rèn, chuyển lật phôi trong khi rèn và 
xếp lại vật đã rèn vào giá hoặc thùng v.v... Sử dụng các loại robot đơn 
giản nhất cũng có thể đưa năng suất tăng 1,5 + 2 lần và hoàn toàn giảm 
nhẹ lao động của công nhân. So với các phương tiện cơ giới và tự động 
khác phục vụ các máy rèn đập thì dùng robot có ưu điểm là nhanh hơn, 
chính xác hơn và cơ động hơn. 


Hình 1.5. Sơ đồ làm uiệc của robot RBM - 5 
phục uụ_ máu đột đập cỡ nhỏ. - 


- "Trên hình 1.5 là sơ đồ làm việc của robot từ vị trí (1) quay sang 
phải tới vị trí (2) rồi hạ xuống vị trí (3). Sau khi Kẹp chì tiết tay máy nâng 
lên vị trí (4) rồi quay sang tới vị trí (5) và ha xuống vị trí (6) để đạt chỉ 
tiết vào băng chuyền. Tay máy tiếp tuc nâng lên tới vị trí (7) và quay sang 
vị trí xuất phát (8) chờ tín hiệu mở máy. Ở dây dùng các npoại tín hiệu từ 
L§1. L§2, LS3 báo vị trí cao nhất của đầu trượt, vị trí trên và dưới của 
thiết bị nâng phói. 

3) Các quá trình hàn và nhiệt luyện thường bao gồm nhiều công 
việc nặng nhọc, độc hai và ở nhiệt độ cao. Đo vậy ở đây cũng nhanh 
chóng ứng dụng Kí thuật robot công nghiệp. 
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Hình 1.6. Sơ đề bố trí robot phục uụ nhiệt luuện bánh răng. 


Trên hình 1.6 giới thiệu sơ đồ bố trí robot phục vụ việc nhiệt 
luyện bánh rang ở Công ty Kawasaki Nhật Bản. Bánh răng chiếm các vị 
trí sau đây trong quá trình nhiệt luyệt: I - vị trí trong lò: 2 - vị trí chờ vào 
lò nung; 3 - vị trí lấy từ băng chuyền; 4 - vị trí trên máy ép; 5 - vị trí trên 
băng chuyền khi đã nhiệt luyện xong. Tay máy (6) trong vùng hoạt động 
(7) ngoài việc vươn tới các vị trí kể trên còn điều khiển thiết bị phụ đưa 
chỉ tiết ra vào lò nung. 
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Rohot được sử đụng phổ biến nhất là trong việc tự động hoá quá 
trình hàn. đặc biệt trong kỹ nghệ ôtô. Trên hình L7 là sơ đồ làm việc của 
robot trên đây chuyền hần vỏ ôtô Toyota (Nhật Bản). 


Khi sử dụng robot trone việc 
hàn, đặc biệt là hàn hổ quang 
với mới hàn chạy theo đường 
cong không gian cần phải dâm 
báo xao cho điều chính được 
phương và khoảng cách của 
điện cực so với mặt pháng của 
mỗi hàn. Nhiệm vụ đó cần được 
xem xét khi tổng bợp chuyển 
động của bàn kẹp và xây dựng 
hệ thống điều khiển có liên hệ 
phản hồi. Kimh nghiệm cho thấy 
rằng có thể thực hiện tốt công 
việc hàn nếu thông số chuyển 
động của đầu điện cực và chế độ 
hàn được điểu khiến bằng một 
chương trình thống nhất, đồng 
thời nều được trang bị các bộ 
phận cảm biến, kiểm tra và hiệu 
chính. Ngoài ra robot hần còn 
pháp huy tác dụng lớn khi hàn 
Hình 1.7. Sơ đề lảm oiệc của roboi trong những môi trường đặc 
trên dây chuyển hàn 0ó ô tô Toyota. biệt, 


4) Robot được dùng khá rộng rãi trong gia công và lắp ráp. 
Thường thường người ta sử đụng tobot chủ yếu vào các việc tháo lắp phôi 
và sản phẩm cho các máy gia công bánh răng, máy khoan, máy tiên bán 
tự động v...v. Trên hình 1.8 là một ví dụ ứng đụng robot phục vụ máy tiện 
bán tự động gia công các trục bé. Robot RBM - 1600 lần lượt lấy phôi đã 
được xếp thành đấy đưa vào mâm cập chuyên dùng, Kẹp chặt bằng thuỷ 
lực. Rồi sau khi gia công xong lại tháo chỉ tiết xếp vào băng chuyển. Trên 
tay máy láp hai bàn kẹp, dòng cho phôi và dùng cho sản phẩm. Các con 
số trên hình vẽ chỉ các vị trí liên tiếp của tay máy. Dưới thân máy có bang 
tái thoát phoi. 

Trong ngành chế tạo máy và dụng cụ đo chỉ phí vẻ lắp ráp thường 
chiếm đến 40% giá thành sản phẩm. Trong lúc đó mức độ cơ khí hoá lắp 
ráp không quá 10 + 15% đối với sản phẩm hàng loại và 40% đối với sản 
xuất bàng loạt lớn. Bởi vậy việc tạo ra và sử dụng robot lắp táp có ý nghĩa 
tất quan trọng. 


Hình 1.8. Kobot phục uụ múy tiện bán tự động. 


Phân tích quá trình lắp ráp chúng ta thấy răng con người khi gá 
đặt các chỉ tiết để lắp chúng với nhau thì có thể làm nhanh hơn các thiết 
bị tự động, nhưng khi thực hiện các động tác khác trong quá trình ghép 
chặt chúng thì chậm hơn. Bởi vậy yếu tố thời gian và độ chính xác định vị 
là vấn đề quan trọng cần quan tâm nhất khi thiết kế các loại robot lấp ráp. 
Ngoài ra, yêu cầu hiện nay đối với các loạt robot lắp ráp là nâng cao tính 
linh hoạt để đáp ứng nhiều loại công việc, hạ giá thành và đễ thích hợp 
với sản xuất loạt nhỏ. 

Ngày nay đã xuất hiện nhiều đây chuyển tự động gồm các máy 
vạn nàng với robot công nghiệp. Các dây chuyền đó đạt mức độ tự động 
cao, tự động hoàn toàn không có con người trực tiếp tham gia, rất linh 
hoạt và không đòi hỏi đầu tư lớn. Ở đây các máy và robot trong dây 
chuyền được điều khiển bằng cùng một hệ thống chương trình. 


Để mở rộng phạm vì 
và khả năng hoạt động của 
robot người 1a còn đùng các 
thiết bị phân phối phụ. Trên 
hình 1.9 giới thiệu một loại 
cơ cấu phân phối (3) có 
đạng khung chữ thập xoay. 
Ở mỗi đầu nhánh của 
khuns chữ thập được lắp 
một bàn kẹp để nhận phôi 
do robot (2) theo lệnh của 
bàn điều khiển (1) lấy từ ổ 
(10) đưa tới, Rồi các tay 
máy đơn gián (5. 7, 9) lần 
lượt đưa phối từ bô phận 
phân phối vào mâm cập của 
các máy tiện bán tự động 
(4. 6, 8)Theo trình tự ngược 
lại các cơ cấu phụ và robot 
sẽ lần lượt đưa các ch: tiết 
đã gia công xong ra ngoài. 


Hình 1.9. Cơ cấu phán phối phụ 


Trong một dây chuyền tự động có các máy điều khiển theo 
chương trình robot có thế đứng một chỗ, chuyển dịch trên đường ray hoặc 
treo đi động, Trên hình 1.LO hai robot (2) và (12) đứng tại chỏ, phối hợp 


Hình 1.10. Sơ đổ bố trí robot phối hợp lảm uiệc trên dâu chuuền tự động. 
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với robot (7) treo di động trên đường trượt (5) phục vụ bốn máy (3, I1, 
14, 15) điều khiển theo chương trình. Ngoài ổ phôi (4), thùng đựng chỉ 
tiết (8) và (10) còn có bàn lật phôi (6) và (9). 

Sử dụng robot treo di động, có thể đơn giản hoá dây chuyền tự 
động, nhất là khi gia công các chi tiết phức tạp. Một robot treo đi động có 
thể phục vụ không phải bốn máy như trên hình 1.10 mà 10 + 15 máy hoặc 
hơn nữa như trên hình I.[ 1. 


L6 


Hình 1.11. Dây chuyền máy phay tự động có hai robot phục uụ 


Kỹ thuật robot có ưu điểm quan trọng nhất là tạo nên khả năng 
linh hoạt hoá sản xuất. Việc sử dụng máy tính điện tử, robot và máy điều 
khiển theo chương trình đã cho phép tìm được những phương thức mới 
mẻ để tạo nên các dây chuyền tự động cho sản xuất hàng loạt với nhiều 
mẫu, loại sản phẩm. Dây chuyền tự động "cứng" gồm nhiều thiết bị tự 
động chuyên dùng đòi hỏi vốn đầu tư lớn, nhiều thời gian để thiết kế và 
chế tạo trong lúc quy trình công nghệ luôn luôn cải tiến, nhu cầu đối với 
chất lượng và quy cách của sản phầm luôn luôn thay đổi. Bởi vậy nhu cầu 
"mềm” hoá hay là linh hoạt hoá đây chuyền sản xuất ngày càng tăng. Kỹ 
thuật robot công nghiệp và máy vi tính đã đóng vai trò quan trọng trong 
việc tạo ra các dây chuyền tự động linh hoạt. 

Xuất phát từ nhu cầu và khả năng linh hoạt hoá sản xuất, trong 
những năm gần đây không những chỉ các nhà khoa học mà cả các nhà sản 
xuất đã tập trung sự chú ý vào việc hình thành và áp dụng các hệ sản xuất 
tự động linh hoạt, gọi tắt là hệ sản xuất lính hoạt (SXLH). Trong các tài 
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liệu nước ngoài thường dùng các từ viết tất theo tiếng Anh FEMS 
(Flexible Manufacturing System) để diễn tả hệ sản xuất linh hoạt. Hệ 
SXLH ngày nay thường bao gồm các thiết bị gia công được điều khiến 
bằng chương trình số, các phương tiện vận chuyển và kho chứa trong 
phân xưởng đã được tự động hoá và nhóm robot công nghiệp ở các vị trí 
trực tiếp với các thiết bị gia công hoặc thực hiện các nguyên công phụ. 
Việc điều khiển và kiểm tra hoạt động toàn bộ hệ SXLH là rất thích hợp 
với quy mô sản xuất nhỏ và vừa, thích hợp với yêu cầu luôn luôn thay đổi 
chất lượng sản phẩm và quy trình công nghệ. Bởi vậy ngày này hệ SXLH 
thu hút sự chú ý không những ở các nước phát triển và ngay cả ở các nước 
đang phát triển. Trong một số tài liệu nước ngoài hệ EMS (Flexible 
Manufacturing System) này được diễn giải như hệ sản xuất của tương lai 
(Future Manufacturing System), sự trùng lặp các từ viết tắt này không 
phải ngẫu nhiên. 


Hình 1.12. Tủ lệ phân bố uề loại 
công uiệc được dùngrobot 


L. Đức áp lực 18,3% 
2. Hàn điểm 14,7% 
3. Hàn hồ quang 12,3% 
4. Cấp thoát phôi 9.6% 
5. Lắp ráp 9.5% 
6. Nghiên cứu /Đào tạo 5,7% 
7. Phun phủ bề mặt 5,7% 
8. Nâng chuyển, sắp xếp 3,9% 
9. Các việc khác 20,3% 


Hình 1.13. Sơ đồ phân bố tủ lệ các 
loại robot uới các loại phương pháp 
diều khiển khác nhau. 

A - Tay máy điều khiển bằng tau 4% 

B- Robot được điều khiển theo 

chu kù cứng 59% 
C- Robot được điều khiển theo 

chu kù thay đổi theo 


chương trình 11% 
D- Robot được điều khiển dùng 
chương trình dạy học 18% 
E- Robot điều khiển theo theo 
chương trình số 5% 
F - Robot được điều khiển có xử lú 
tỉnh khôn 3% 


Trên hình í.12 là các số liêu của Hiệp hội Robot nước Anh 

(BRA - British Robot Associadon) và biểu đồ tỷ lệ phân bố về các loại 
công việc được sử dụng robot. Còn hình 1.13 là biểu đồ phân bố tý lệ các 
loại robot sử dụng các phương pháp điều khiến khác nhau. Đây là kết quả 
khảo sát của Hiệp hội Robot công nghiệp Nhật Bản CTIRA - lapan 
Tndustrial Robot Assciation) năm 1981. Tuy chưa có các số hiệu thống kê 
trong những năm gần đây nhưng chấc chắn bức tranh trên hình 1.13 đã 
thay đổi đi nhiều vì sự tác động của các tiến bộ kỹ thuật về cơ - tin - điện 
tử (mechatronies) và tốc độ giảm giá nhanh của thiết bị vị xử lý. 


14. NỘI DUNG NGHIÊN CỨU PHÁT TRIỂN ROBOT 
CÔNG NGHIỆP. 
1.4.1. Nhân xét về quá trình phát triển robot công nghiệp. 


Ra đời từ những năm 5Ó, robot công nghiệp đã có những bước 
phát triển quan trọng. Từ năm 1960 đo sự xuất hiện máy vi tính, robot 
công nghiệp đã tiếp thu được thành tựu mới đó và ngày càng hấp dẫn. 
Cao trào phát triển vào những năm 70 và đánh dấu mốc bàng Hội nghị 
quốc tế lần thứ 6 về "thiết kế chế tạo và ứng dụng robot công nghiệp” 
Chicago năm 1972. Sau đồ lại lắng đân xuống, nhất là sau khủng hoảng 
đầu mỏ 1975 như để rút kinh nghiệm áp dụng vào chỗ nào là phát huy 
hiệu quả cao hơn. Đến những năm 80 thì xuất hiện nhu cầu hình thành 
các lệ thống sản xuất linh hoạt FMS (Flexiblc Manufacturing System) 
mà robot như là bộ phận cấu thành FMS. Nhu cầu đó kích thích bước phát 
triển của robot công nghiệp. Trong năm 90 robot công nghiệp cũng có 
bước phát triển mới theo hướng đồng bộ hệ thống trên cơ sở vân dụng 
những thành tựu của công nghệ thông tin ứng đụng. 


Bản thân phần kỹ thuật, robot công nghiệp cũng thể hiện các xu 
thế phát triên sau đây: 


1) Trong giai đoạn đầu phát triển người ta rất quan tâm đến việc 
tạo ra những cơ cấu tay máy nhiều bậc tự do, được trang bị nhiều loại 
cảm biến (sensor) để có thể thực hiện được những công việc phức tạp, 
như là để chứng tỏ khả năng thay thế con người trong nhiều loại hình 
công việc, 


2) Khi đã tìm được các địa chỉ ứng đụng trong công nghiệp, thì 
việc đơn giản hoá kết cấu để tầng độ chính xác định vị và piảm giá thành 
đầu tư lại là những yêu cầu thực tế đối với thị trường hàng hoá cạnh tranh. 
Ngày càng có nhiều cải tiến quan trọng trong kết cấu các bộ phận chấp 
hành, tăng độ tin cậy của các thiết bị điều khiến, tăng mức thuận tiện và 
đẻ dàng khi lập trình v.v... 


3) Để mở rộng phạm vi ứng dụng cho robot công nghiệp nhằm 
thay thế lao động nhiều loại hình công việc, ngày càng rõ nét về xu thế 
tăng cường khả năng nhận biết và xử lý tín hiệu từ môi trường làm việc. 
Các thành tựu khoa học và tiến bộ kỹ thuật laser, kỹ thuật tỉa hồng ngoai, 
kỹ thuật xử lý ảnh v.v... đã ngày càng hiện thực xu thế phát triển robot 
còn nghiệp hướng vào việc thích nghĩ được với môi trường làm việc. 

4) Cùng với các xu thế trên, robot công nghiệp luôn luôn được 
định hướng tăng cường năng lực xử lý công việc để trở thành các robot 
tỉnh khôn nhờ áp dụng các kết quả nghiên cứu về hệ điều khiển nơron và 
trí khôn nhân tạo v.v... 

1.4.2. Cơ - tin - điện tử và robot công nghiệp. 


Cơ - tín - điện tử và robot công nghiệp là 2 lĩnh vực khoa học kỹ 
thuật cao rất gắn bó với nhau. Ở một số nước chúng kết hợp với nhau như 
là một ngành học. Trong robot công nghiệp có hầu hết các vấn đề của cơ 
điện từ. Đồng thời sự phát triển của cơ điện tử cũng đều phản ánh trong 
kỹ thuật robot. Vì vậy để nghiên cứu về robot cần xem xét các văn đề 
cơ - tin - điện tử, 

Thuật ngữ "cơ - tin - điện tử” (mechatronics) thể hiện stựr kết hợp 
giữa cơ học máy với công nghệ thông tin vì điện tử học 
(mieroelectronics). Ý tưởng chủ yếu ban đầu của cơ - tin - điện tử là cài 


_——————" Công nghệ thông tin ¬ 


Xu thế mở rông 
khả nàng của con 
người 


Công nghệ 
cơ khí 


Công nghệ 
thuy khí 


Kỹ thuật vị 
điện tử 


Kỹ thuật cảm 
biến biến đối 


Kỹ thuật 
điện, diện 


Kỹ thuật he b Cơ điện từ / robot 


thông 


Điều khiển kỹ thuật 


Anh hưởng tới cấu trúc xí nghiệp 


Tự dộng Tự động Tự động Tự động 
hoá. robol hoá thiết há kho hoá công 

hoá sản kế và vân Việc các 
xuất chuyến phòng ban 


Hình 1.14. Sơ đồ quan hệ. 21 


đặt các thiết bị điều khiển vi điện tử vào các máy thông thường. Dần 
dần bản thân bên trong máy cũng thay đối đi và chức năng của máy cũng 
được mở rộng thêm nhiều. Còn về thiết bị điện tử, chính xác hơn là vị 
điện tử, thì các tiến bộ mới cũng không ngừng được áp dụng, từ các mạch 
tích phân IC (Inteprated Circui0, các bộ vi xử lý (Microprosessor), các bộ 
điểu khiển lập trình được PLC ( Programmable Logical Controller). các 
máy tính PC v...v. 


Phần nối ghép thành hệ thống giữa các thiết bị điều khiển vi điện 
tử với các thiết bị chấp hành trong máy (có thể là thiết bị cơ, thiết bị thuỷ 
khí, thiết bị điện hoặc điện từ) chủ yếu là các bộ cảm biến (sensor), các 
bộ biến đổi (converfer) và các thiết bị của công nghệ thông tin. 


Sơ đồ trên hình 1.14 cho ta hình dung về các mối quan hệ và ảnh 
hưởng của cơ điện tử và robot đến cấu trúc của xí nghiệp công nghiệp. 


1.4.3. Robot và hệ thống sản xuất linh hoạt. 


Nhu cầu của thị trường cạnh tranh luôn luôn đòi hỏi các nhà sản 
xuất phải thay đổi mẫu mã, kích cỡ và thường xuyên cải tiến nâng cao 
chất lượng sản phẩm. Như vậy sự cạnh tranh hàng hoá đặt ra một vấn đề 
thời sự là phải có hệ thống thiết bị sản xuất thay đổi linh hoạt được để có 
thể đáp ứng với sự biến động thường xuyên của thị trường. Nhờ sự phát 
triển trong mấy chục năm gần đây của kỹ thuật số và công nghệ thông tin 
chúng ta mới có khả năng "mềm" hoá hệ thống thiết bị sản xuất. Trên cơ 
sở đó đã ra đời hệ thống sản xuất linh hoạt FMS là phương thức sản xuất 
hiện đại. Nó có ưu điểm cơ bản là các thiết bị chủ yếu của hệ thống chỉ 
đầu tư một lần, còn đáp ứng lại sự thay đổi sản phẩm bằng phần mềm 
máy tính điều k¡ .ến là chính. Hệ thống FMS rất hiện đại nhưng lại thích 
hợp với qui mô sản xuất vừa và nhỏ. Ngày nay ở các nước phát triển các 
hệ thống FMS có xu hướng thay thế dần các hệ thống thiết bị tự động 
"cứng" sản xuất hàng loạt lớn sản phẩm. Các hệ thống thiết bị tự động 
cứng này rất đắt tiền mà kh! thay đổi về yêu cầu sản phẩm thì phải đối 
mới gần như hoàn toàn. Như vậy, chúng nhanh chóng trở nên lạc hậu vì 
không thích nghi được với thị trường đầy biến động. 


Ý tưởng chủ đạo trong việc tổ chức hệ thống sản xuất hiện đại 
linh hoạt là "nh hoạt hoá” và "môđun hoá". Một hệ thống sản xuất linh 
hoạt cá thể gồm nhiều môđun linh hoạt. Một trong những hệ thống như 
vậy là n2 'hống CIM (Computer Integrated Manufacturing) - hệ thống 
tích hợp sản xuất dùng máy tính. 


Để tạo ra những môđun sản xuất linh hoạt đó cần có mặt robot 
như một bộ nhận cấu thành. Ở đây, robot làm những công việc chuyển 
tiếp giữa các máy công tác (ví dụ, cấp thoát phôi và dụng cụ cho các 
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trung tâm gia công), vận chuyển trong phân xưởng, thao tác trong kho tự 
động v.v... : 


Bản thân cơ cấu tay máy của robot cũng là một cơ cấu linh hoạt. 
Đó là cơ cấu không gian hở (không kép kín), có bậc tự do dư thừa nên độ 
cơ động rất cao. Mỗi khâu của cơ cấu có động lực riêng và chúng được 
điều khiển bằng chương trình thay đổi được. Có loại robot lại có thể tự 
thay đối được thao tác của mình một cách linh hoạt khi nhận biết được 
các tín hiệu từ sự hoạt động của bản thân (nội tín hiệu). Những cơ cấu 
như vậy gọi là cơ cấu điều khiển linh hoạt. 


1.4.4. Robot song song. 


Sơ đồ động cơ cấu tay máy thông thường là một chuỗi nối tiếp 
các khâu động, còn trong robot song song (RBSS) ở một khâu nào đó 
có thể nối động với nhiều khâu khác, tức là aối song song với nhau và 
cùng hoạt động song song với nhau. Sự khác nhau về sơ đồ động đó cũng 
gây ra nhiều đặc điểm khác biệt vẻ động học và động lực học. Ví dụ, đối 
với robot thông thường thì giải bài toán động học thuận dễ dàng hơn 
nhiều so với bài toán động học ngược, còn đối vớt RBSS thì hoàn toàn 
ngược lại. 


Vấn đề RBSS trở nên hấp dẫn nhiều nhà nghiên cứu từ giữa 
thập kỷ 90 khi nó được ứng dụng đưới dạng thiết bị có tên là Hexapod 
-_ để tạo ra máy công cụ 5 trục ƠNC có trục ảo. Hexapod là một môđun 
RBSS được kết cấu trên nguyên lý cơ cấu Stewart. Cơ cấu này gồm có 6 
chân, với độ đài thay đổi được, nổi với giá và tấm động (moving 
platform) đều bằng các khớp cảu. Bằng cách thay đổi độ dài của các 
chân, có thể điều khiển sự định vị và định hướng của tấm động theo ý 
muốn. Stewart đã để xuất sử dụng cơ cấu này để mô phỏng hoạt động của 
thiết bị bay. 


Như đã biết, máy cát gọt CNC 3 trục không đáp ứng được các yêu 
cầu gia công chính xác các bề mặt phức tạp. Vì thế xuất hiện nhu cầu tạo 
ra các máy CNC § trục, tức là ngoài các trục X, Y, Z. bổ sung thêm 2 trục 
quay có thể thực hiện được trên bàn máy mang vật gia công hoặc trên giá 
đỡ trục dụng cụ cắt. Các máy CNC §5 trục này rất đắt tiền, gần gấp đôi 
máy CNC 3 trục, Nếu sử dụng cơ cấu Hexapod để tạo ra các trục hoặc tạo 
ra các trục bố sung thì giá thành máy CNC trục ảo này có thể h¿ !iấp 
nhiều lần. 

Ngoài các ứng dụng trong ngành chế tạo máy công cụ RBSS còn 
được áp dụng hiệu quả trong dụng cụ y học, trong hệ thống mô phỏng, 
trong thiết bị thiên văn, trắc địa và trong kỹ thuật phòng không v.v. 


1.4.5. Các xu thế ứng dựng robot trong tương lai. 


Robot ngày càng (hay thế nhiều lao động 


Ở đây chỉ đề cập đến robot công nghiệp. Trong tương lai kỹ thuật 
tobot sẽ tận dụng hơn nữa các thành tựu khoa học liên ngành, phát triển 
cả về phần cứng, phần mềm và ngày càng chiếm lĩnh nhiều "trận địa” 
trong công nghiệp. Số lượng lao động được thay thế ngày càng nhiều vì 
mội mặt giá thành robot ngày càng giảm đo hàng vì điện tử giảm giá liên 
tục, mặt khác chỉ phí tiền lương và các khoản phụ cấp cho người lao động 
lại càng tăng. 


Robot ngày càng HrỚ nên chuyên đụng 


Khi robot công nghiệp ra đời người ta thường cố gắng làm sao để 
biểu thị hết khả năng của nó. Vì thế xuất hiền rất nhiều loại robot vạn 
năng có thể làm được nhiều việc trên dây chuyền. Tuy nhiên, thực tế sản 
xuât chứng tỏ rằng, các robot chuyên môn hoá đơn giản hơn, chính xác 
hơn học việc nhanh hơn và quan trọng là rẻ tiên hơn robot vạn năng. Các 
robot chuyên dụng hiện đại đều được cấu thành từ các môđun vạn năng. 
Xu thế môdun hoá kết cấu robot ngày càng phát triển nhằm chuyên môn 
hoá việc chế tạo các môódun và từ các môdun đó sẽ cấu thành các kiểu 
robot khác nhau thích hợp cho từng loại công việc. 


Robot ngày càng đảm nhán được nhiều loại công việc lắp rắp 


Công đoạn lắp rấp thường chiếm tỷ lệ cao so với tổng thời gian 
sản xuất trên toàn bộ đây chuyển. Công việc khi lắp ráp đó lại đòi hỏi 
phải rất cẩn thận, không được nhầm lẫn, thao tác nhẹ nhàng, tỉnh tế và 
chính xác nên cần có thợ tay nghề cao và phải làm việc căng thẳng suốt 
ngày. 

Khả năng thay thế người lao động ở những khâu lắp ráp ngày 
càng hiện thực là do đã áp đụng được nhiều thành tựu mới vẻ khoa học 
trong việc thiết kế, chế tạo robot. Ví dụ tạo ra những cấu hình đơn giản và 
tất chính xác trên cơ sở sử dụng các vật liệu mới vừa bền, vừa nhẹ. Trong 
đó nên kế đến các loại robot như Adept One, SCARA, v...v. Đồng thời do 
được thừa hưởng sự phát triển kỹ thuật nhận và biến đổi tín hiệu (senso#'). 
đặc biệt là kỹ thuật nhận và xử lý tín hiệu ảnh (vix¿2n) cũng như kỹ thuật 
tin học với các ngôn ngữ bậc cao, robot côn nphiệp đã có mặt trên nhiều 
công đoạn lắp ráp phức tạp. 


®obot dị động ngày càng trở nên phố biến 


Trong các nhà máy hiện đại tên gọi phương tiện dẫn đường tự 
động AVG (Automatic Guided Vehicles) đã trở thành quen biết. Loại đơn 
slàn là những chiếc xe vận chuyển trong nội bộ phân xưởng được điều 
khiển theo chương trình với một quỹ đạo định sẩn. Càng npày các thiết bị 
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loại này cũng được hiện đại hoá nhờ áp dụng kỹ thuật vision ba chiều, 
kỹ thuật sensor tín hiệu xa, kỹ thuát thông tin vô tuyến hoặc dùng tia 
hỏng ngoại v...v. Vì vậy AGV đã có thể hoạt động linh hoạt trong phân 
Xưởng. Đó là đu robot di động và còn gọi là robocar, Một hướng phát 
triển quan trọng của robocar là không di chuyên bằng các bánh xe mà 
bằng chân, thích hợp với mọi địa hình. 


Robot đi được bằng chân có thể tự leo bậc thang là một đối tượng 
đang được rất cbú ý trong nghiên cứu không những định hướng sử dụng 
trong cóng nghiệp hạt nhân hoặc trong kỹ thuật quốc phòng mà ngay cả 
trong công nghiệp dân dụng thông thường. Ở đây việc tạo ra các cơ cấu 
chấp hành cơ khí bền vững, nhẹ nhàng, chính xác và linh hoạt như chân 
người lạt là đối tượng nghièn cứu chủ yếu. 


Jềobol ngày càng Hrở nên tình khôn liờn 


Trí kbôn nhân tạo là một vấn đề rất dược quan tâm nghiên cứu với 
các mục đích khác nhau. Kỹ thuật robot cũng từng bước áp dụng các kết 
quả nghiên cứu về trí khôn nhân tạo và đưa vào ứng dụng công nghiệp. 
Trước hết là sử dụng các hệ chuyên gia, các hệ thị giác nhân †ạo, mạng, 
nơron và các phương pháp nhận dạng tiếng nói v.v... Cùng với những 
thành tựu mới trong nghiên cứu về trí khôn nhân tạo robot ngày càng có 
khả năng đảm nhận được nhiều nguyên công dây chuyển sản xuất đòi hỏi 
sự tỉnh khên nhất định. 


Vấn đề thiết bị cảm biển được nhiều ngành kỹ thuật quan tâm và 
cũng đạt được nhiều thành tự mới trong thời kỳ phát triển sôi động của kỹ 
thuật vị xử lý. Đó cũng là điều kiện thuận lợi cho việc áp dụng chúng 
trong kỹ thuật robot nhằm tăng cường khả năng thông mình của thiết bị. 


Những loại hình được quan tâm nhiều trong công nghiệp là các 
robot thông minh cố các môđun cảm biến nhận biết được khoảng cách để 
tránh vật cản khi thao tác, cảm biến nhận biết được màu sắc khi phân loại. 
cảm biến được lực khi lấp ráp v.v. Khi được lấp thêm các môđun cảm 
biến này robot được gọi nhiều tên mới, ví dụ, robot "nhìn được” (vision 
robot), robot lắp ráp (assembly robot). robot cảnh báo (alarm robot) v...V. 


Để thông mình hoá robot bên cạnh việc cài đặt bổ sung các 
môdun cảm biến “nội tín hiệu” và các môđun cảm biến “ngoại tín hiệu” 
thì đồng thời có thể thông minh hoá robot bằng các chương trình phần 
mềm có khả năng tự thích nghĩ và tự xử lý các tình huống v...v. 

Như vậy bằng cách bố sung các môđun cảm biến và các môđun 
phần mẻm phù hợp có thể nâng cấp cải tiến thông minh hoá nhiều loại 
robot. Tuy nhiên bản thân các robot này phải có các cơ cấu chấp hành 
linh hoạt và chính xác. Ngày nay có nhiều loại robot thông ranh không 
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những có thể làm việc trong các phân xưởng công nghiệp mà còn thao 
tác được ở bên ngoài, trên các địa hình phức tạp như các loại robot vũ trụ 
(spacc robot), robot tự hành (walking robot), robot cần cầu (robocrane), 
tạo dựng từ các môđun robot song song v...V. 


1.5. TÌNH HÌNH TIẾP CẬN VÀ ỨNG DỤNG ROBOT 
CÔNG NGHIỆP Ở VIỆT NAM. 


Trong giai đoạn trước năm 1990 hầu như trong nước hoàn toàn 
chưa du nhập về kỹ thuật robot, thậm chí chưa nhận được nhiều thông tin 
kỹ thuật về lĩnh vực này. Tuy vậy, với mục tiêu chủ yếu là tiếp cận kỹ 
thuật mới mẻ này, trong nước đã triển khai các đề tài nghiên cứu khoa 
học cấp nhà. nước: Đề tài 58.01.03 trong giai đoạn 81 - 85 và đề tài 52 
B.03.01 trong giai đoạn 86 - 89. Kết quả nghiên cứu của các đề tài này 
không những đáp ứng được yêu cầu tiếp cận mà còn có những ứng dung 
ban đầu trong kỹ thuật bảo hộ lao động và phục vụ công tác đào tạo cán 
bộ kỹ thuật ở nước ta. 


Giai đoạn tiếp theo từ năm 1990 các ngành công nghiệp trong 
nước bát đầu được đổi mới. Nhiều cơ sở đã nhập ngoại nhiều đây chuyền 
thiết bị mới. Đặc biệt là ở một số cơ sở liên doanh với nước ngoài đã nhập 
ngoại nhiều loại robot phục vụ các công việc sau đây: 


- Tháo lấp các dụng cụ cho các trung tâm gia công và các máy 
CNC. 


- Lắp ráp các linh kiện điện tử. 


- Tháo sản phẩm ở các ruấy ép nhựa tự động, trong đó có loại thao 
tác phối hợp với hệ thống giám sát, điều khiển bằng camera. 


- Hàn vỏ xe ôtô. 
- Phun phủ các bề mặt v.v. 


Tuy nhiền còn có bàng chục cơ sở trong nước lúc mua dây chuyền 
đã không nhập các robot có trong danh mục các thiết bị của đây chuyền 
chào hàng. Trong đó có một số cơ sở đã nhận ra nhu cầu là phải có robot 
mới đảm bảo được chất lượng sản phẩm của dây chuyền như thiết kế, Vì 
vậy đã xuất hiện các nhu cầu bổ sung các robot đó. 


Một sự kiện đáng được quan tâm là từ tháng 4/98 Nhà máy 
Rorzc/Robotech đã bước vào hoạt động ở khu công nghiệp Nomura Hải 
Phòng. Đây là nhà máy đầu tiên ở Việt Nam chế tạo và lắp ráp robot. Đó 
là loại robot có cấu trúc đơn giản nhưng rất chính xác dùng trong sản xuất 
chất bán dẫn. Nhà máy Rorze Robotech có vốn đầu tư là 46 triệu đồ la 
Mỹ do Nhật Bản đầu tư. 
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Trong những năm gần đây Trung tâm Nghiên cứu Kỹ thuật (NCT) 
Tự đóng hóa, trường Đại học Bách khoa (ĐHBK) - Hà Nội dã nghiên cứu 
tính toán thiết Kế một kiểu robot mới. Ký hiệu là Robot RP. Robot RP thuộc 
loại robot phóng sinh (bất chước cơ cấu tay người). Sự khác biệt của robot 
này với các Kiểu robot phỏng sinh khác là ở đay dùng cơ cầu pantograph với 
2 con trượt đản động làm môđun chủ yếu của cơ cấu tay máy. Cũng vì thẻ 
robot này được ký hiệu văn tắt là RP. Hiện nay đã chế tạo ra hai mẫu: Robot 
JRJ?S - 406 dùng để phun men. có hệ thống truyền dẫn thủy lực với 5 bậc tự 
do và Robot RP§ — 4102 dùng trong công nghệ bề mặt, có 6 bậc tự do. 3 
động cơ điện l chiêu và 3 động cơ bước. 


Trên hình 1.15 là ảnh chụp Robot RPS — 406 và trên hình 1.16 là 
robot JXPS — 4102. 


= ... * ` “` 


Hình 1.15. Robot RPS - 406 


Hình 1.16. Fo›ot RPB - 410 


Cơ cấu chấp hành của Robot RPS - 4102 có 6 bậc tự do, chía thành 2 
nhóm: nhóm 3 bậc tự đo thứ nhất gọi là nhóm 3 (1), giống như trong lšobot 
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RPS — 406. nhưng ở nhóm 3 (2) thì khác, ở đây dùng 3 môđun truyền 
dộngvới động cơ bước để hình thành các chức năng của cổ tay. 

Trên hình 1.17 là ảnh chụp các Robot SCA mini do Trung tâm 
NCKTT Tự động hóa, ĐHBK — Hà Nội thiết kế, chế tạo cung cấp cho một số 
trường. chủ yếu dùng để giảng dạy, học tập. nhưng đồng thời có thể sử dụng 
để lắp ráp hoặc sắp xếp các vật nhỏ dưới 1 kg. 


Hình 1.17. Robot SCA_ mini 


Các sản phẩm giới thiệu trên hình 1.18. hình 1.19 và hình 1.20 cũng 
do Trung tầm NCKT tự động hoá, ĐHBK - Hà Nội thiết kế, chế tạo. 


Hình 1.15 là robocar công nghiệp, phục vụ trong phân xưởng. Nó vó 
Khả nâng tự động nhận biết đường di chuyển. tự động phát hiện và xử lý khi 
gặp chướng ngại vật. Ngoài khả năng di chuyển trên gàn nó còn có + bậc tự 
do thao tác, dạng công gấp theo chương trình. 


Hình 1.18. Robocar phục uụ trong các phân xưởng 


Hình 1.19 có thể xem là một dạng robocar ứng dụng cho thương 
bẻnlr binh. người tàn tật hoặc ốm đau. Trên tay ghế có các nút điều khiển 
theo 2 chế độ “manual” hoặc “automatic°. Tuỳ theo yêu cầu có thể trang bị 
thêm hệ thống phát hiện và xử lý khi gập vật cản đường. 


"" 


Hình 1.19. Xe lăn điện chạy tự động 


Hình 1.20 là robocar “chữ thập đỏ” có thể tự động dị chuyển theo 
hành trình định trước, biết xử lý khi gặp chướng ngại hoặc biết di chuyển với 
khoảng cách không đổi dọc theo tường chắn. Cơ cấu tuy máy 2 bậc tự do 
giúp di chuyển trong không gian đầu phun hoá chất sát trằng dùng trong y 


tế: 
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Hình 1.20. Robocar chữ thập đỏ 


Song song với việc thiết kế, chế tạo các robot nói trên, tại Trung tàm 
NCKT tự động hóa, ĐHBK — Hà Nội, đã thành công trong việc nghiên cứu 
xày dựng các thuật toán mới để xây dựng chương trình tính tóan điều khiển 
robot, xây dựng phương pháp tự động thiét lập và giải các bài tóan động học 
trên cơ sở đùng MATLAB. Trên hình 1.21 là màn hình chương trình tự động 
thiết lập phương trình động họccủa robot, 


Ngoài ra Trung tâm NCKT tự động hóa, ĐHBK - Hà Nội, còn tiền 
hành xây dựng “thư viện” các mô hình động của robot trong máy tính. Cúc 
robot này không nhưỡng được thiết kế theo thông số kỹ thuật của các cơ sở 
sản xuất, mà còn được xây dựng chương trình mô phỏng hoạt hình và 
chương trình điều khiển chúng. Với các chương trình này có thể trình din, 

-_ giới thiệu với khách hàng về sự hoạt động của các robot mới được thiết kế 
mới. Qua đó cũng có thể trao đổi, hiệu chỉnh thiết kế theo yêu cầu. 

Trên hình 1.22 là màn hình mô phỏng hoạt hình robot RPS - 406 
đang phún men, hình 1.23 — Robot RPB - 4102 phục vụ nhiệt luyện tôi cao 


tần, trên hình 1.24 — Robot SCA mini đang xếp hình và trên hình 1.25 mô 
phỏng hoạt hình Robot song song (RBSS). 
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Đăng học rohoi 


MS : 


Ì Sun “TIM LÊN doại 


IPx= a2*C12 + a1ˆ*C1 
Py= a2*S12 + a1*S1 


Hình 1.21. Màn hình chương trình tự động 
thiết lập phương trình động học của robot 


Hình 1.22. Mô phỏng hoạt hình Robot RPŠ - 406 
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Hình 1.24. Mô phỏng hoạt hình Robot SCA mini 
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Hình 1.25. Mô phỏng hoạt hình RBSS 


Trong [34] đã trình bày phương án tạo ra loại robot w bậc tự do 
bằng cách ghép nối tiếp các “khớp cơ sinh”. Bản thân các “khớp cơ sinh” 
này là các môđun RBSS. Loại robot nhiều bậc tự do này linh hoạt như con 
rắn và có thể gọi tên là “con rắn RBSS”. Trên hình 1.23 là hình mô phỏng 
“con rắn RBSS". Nó có thể tìm được nhiều ứng quan trọng như thao tác 
dưới đường hầm, trong ống ngầm v.v... 


Hình 1.26. Hình mô phỏng "Con rắn RBSS" 
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CHƯƠNG II 
CẤU TRÚC, VÀ PHÂN LOẠI ROBOT CÔNG NGHIỆP. 
2.1. CÁC BỘ PHẬN CẤU THÀNH ROBOT CÔNG NGHIỆP 


Trên hình 2.1 giới thiệu các bộ phận chủ yếu của robot công nghiệp 
loại thông thường. 


Tay máy gồm các bộ phận: đế L đặt cố định hoặc gắn liền với xe di 
động 2, thân 3, cánh tay trên 4, cánh tay dưới 5. bàn kẹp 6. 

Bên trong hoặc ở bên ngoài tay máy còn đặt nhiều bộ phận khác nữa: 

Hệ thống truyền đến động có thể là cơ khí, thuỷ khí hoặc điện khí, là 
bộ phận chủ yếu tạo nén sự chuyên dịch ở các khớp động. Trong chương IX 
sẽ khảo sát các thiết bị truyền dẫn dộng này. 

Hệ thống điểu khiển đâm bảo sự hoạt động của robot theo các thông 
tìn đặt trước hoặc nhận biết được trong quá trình làm việc. Trong chuơng 
VINH vấn đề này sẽ được đề cập đến. 
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Hình 2.1. Các bộ phận cấu thành robot 


Hệ thống cam biến tín hiệu thực hiện việc nhận biết và biến đổi thông 
tin về hoạt động của bản thân robot (cảm biến nội tín hiệu) và của môi 
trường, đối tượng mà robot phục vụ (cảm biến ngoại tín hiệu). Trong chương 
XI sẽ trình bày về các thiết bị cảm biến. 


Các thông tin đặt trước hoặc cảm biến được sẽ đưa vào hệ thống điều 
khiển sau khi xử lí bằng máy vi tính, rồi tác động vào hệ thống truyền đẫn 
động của tay máy. 
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Trực tiếp liên hệ với bàn kẹp là các dụng cụ (†ools) thao tác với môi 
trường và đối tượng làm việc. 


Hình 2.2. V¡ dụ uề các kết cấu môtfun. 


Các bộ phận nói trên ngày nay thường được kết cấu theo nguyên tắc 
môđun hoá. Hình 2.2 là một ví dụ về kết cấu của robot. Đạt trên đế dịch 
chuyển được theo phương X là phần thân cội quay được với góc (. Trượt theo 
phương Z. dọc trục thân cót là thân giá, mang trên mình cánh tay ngang. Trên 
cánh tay ngang này, tầm với của tay có thể thay đổi trong khoảng r, đồng 
thời cổ tay có thể quay một góc ơ. 

Trên hình 2.3. a là robot Cincinnatt Milacron - Dainichikiko (Mỹ - 
Nhật) có thể tự động thay dụng cụ thao tác dùng bộ phận chuẩn hoá hình 
2.3b. Các dụng cụ thay thế mô tả trên hình 2.3c lần lượt là: bàn kẹp chân 
không, đá mài. bàn kẹp 2 ngón, súng phun sơn hoặc đầu hàn hơi, ốc vặn, mũi 
khoan, doa bóng v...v. 

2.2. BẬC TỰ DO VÀ CÁC TỌA ĐỘ SUY RỘNG 

Robot công nghiệp là loại thiết bị tự động nhiều công dụng. Cơ cấu 
tay máy của chúng phải được cấu tạo sao cho bàn kẹp giữ vật kẹp theo một 
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Hình 2.3. Robot có dụng cụ thao tác thaụ thế được 


hướng nhất định nào đó và đi chuyển dễ dàng trong vùng làm việc. Muốn vậy 
cơ cấu tay máy phải đạt được một số bác tự do chuyển động. 


Thường thường các khâu của cơ cấu tay máy được nối ghép với nhau 
bằng các khớp quay hoặc khớp tịnh tiến. Gọi chung chúng là khớp động. Các 
khớp quay và khớp tịnh tiến đều thuộc khớp động học loại 5, như đã biết 
trong giáo trình “Nguyên lý máy”. Trong cơ cấu tay máy các khâu nối liên 
tiếp với nhau gọi là cơ cấu hở và thông thường mỗi khâu động gắn liền với 
nguồn động lực riêng, cho nên đối với các loại cơ cấu dùng các khớp động 
loại 5 thì Số bậc tự do của cơ cấu bằng số khâu động. 
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Trong trường hợp chung có thể tính toán số bậc tự do theo công thức 
thông dụng trong Nguyên lý máy: 


W=ón- >_ïp, (2.1) 


tr 
VỚI 

ñ - sò khâu đọng. 

P,- sö khớp loại I. 

Ví dụ, đối với cơ cấu sơ đồ tay người (hình 2.4) có 3 khâu động: khớp 
vai (giữa khâu 0 và khâu 1) và khớp cố tay (giữa khâu 2 và khâu 3) là các 
khớp cầu p;, còn khớp khuyu tay (giữa khâu I và khâu 2) là khớp quay p‹. 
Như vậy theo công thức (2.1), số bậc tự do của cơ cấu sơ đồ tay người W = 7. 
Người ra quy ước là số bậc tự do của cơ cấu tay máy là không kể đến các 
chuyển động đóng mở của bàn kẹp. 

Như vậy, đối với cơ cấu hở, số bậc tự do của cơ cấu bàng tổng số bậc 
tự do của các khớp động. 


Hình 2.4. Cơ cấu sơ đồ tau người 


Hình 2.4 chỉ là cơ cấu sơ đồ tay người, còn bản thân tay người phức 
tạp hơn nhiều và có đến 27 bậc tự do nên thao tác vô cùng tỉnh xảo. Khi mới 
ra đời, các robot đầu tiên được thiết kế bắt chước tay người không chỉ vẻ 
công dụng mà cả về hình đáng bèn ngoài. Nhiều loại tay máy xuất hiện sau 
này lại trông không giống tay người nữa nhưng văn Kệ hiện được các 
chuyền động trong không gian như lay người. 


Trong [34] đã đưa ra khái niệm về "khớp động cơ sinh". Cơ cấu tay 
máy có khâu động nối với nhau bằng các khớp động cơ sinh này là cơ cấu 
tay máy phỏng sinh ở dạng tổng quát nhất. Từ trường hợp tổng quát này có 
thể suy ra các trường hợp riêng như trường hợp có các khóp động thông 
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thường, trường hợp cơ cẩn có một hoặc vài khâu khép kín, trường hợp đó goi 
là cơ cấu tay máy song song v...V. 

Trong các sơ đồ động của 
tobot công nghiệp thường gập, 
các khớp động đều là khớp quay 
hoặc khớp tịnh tiến. Trên hình 2.5 
là ví dụ về sơ đồ của một tay 
DHẬT 


Các cấu hình Khác nhau 
của cơ cấu tay mấy trong từng 
thời điểm được xác định bằng cúc 
độ địch chuyển góc hoặc độ dịch 
chuyển đài của các khớp động 
hoặc khớp tinh tiến. 


Các đó dịch chuyển tức 
thời đó, so với giá trị bản dâu nào 
đó lấy làm mốc tính toán, được 
pỌI là các toạ độ suy rộng (generaliZed joinL coordinatex) tronp nhiều tài 
liệu kỹ thuật vẻ robot công nghiệp, Ở đây người ta còn gọi chúng là các giá. 
trị. Điển khớp (joimt variable). 


+ Hình 2.5. Sơ đồ động của một 
tựu mát toa độ suụ rỗng, 


Sơ đồ động trên hình 2.5 có 6 khớp động loại p.. tức là có 6 bậc tự do. 
Trong 6 độ dịch chuyển q, đến q„. tức là 6 biến khớp (hoặc 6 toa độ suy 
rộng), chỉ có q, là độ dịch chuyển của khớp tịnh tiến siữa khâu 2 đối với 
khâu 1. còn lại là các dịch chuyển góc của các khớp quay. 


Trong trường hợp chung ta gọi q„¡ = l...., n là các biến khớp (toa độ 
suy rộng) của cơ cấu tay máy và biểu thị bằng: 


q=Š,0,+(I-Š)S, (2.2) 
với : 
1, đối với khớp quay 
0. đối với khớp tịnh tiến 
6, - độ dịch chuyển góc của các khớp quay 
Š_~ độ dịch chuyển tịnh tiến của các khớp tịnh tiến. 
2.3. NHIỆM VỤ LẬP TRÌNH ĐIỀU KHIỂN ROBOT 


L) Định vị và định hướng trú sŠiểm tác động cuôi”. 
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Khaảu cuối cùng của cơ cấu fay máy thường là bàn kẹp (gripper) 
hoc là khâu pắn liền với dụng cụ thao tác (tool). Điềm mút của kháu cuối 
cùng là điểm đáng quan tâm nhất vì đó là điểm tác động của robot lên đối tác 
và dược gọi là "điểm tác động cuối” (end - effcctor), Trén hình 2.6 điểm E là 
"điểm tác động cuối” khi bàn kẹp là khâu cuối và khi dụng cụ thuộc về khàu 
cuối. 


Hình 2.6. Định ơị uà định hướng tại "điểm tác động cuối" 


Chính tại "điểm tác động cuối” E này cần quan tâm không những vì 
trí nó chiếm trong không gian làm việc mà cả hướng tác động của khâu cuối 
đó. VỊ trí của điệm E được xác định bằng 3 tọa độ x;, Vụ, 2, trong hệ toa độ 
cố định. Còn hướng tác động của khâu cuối có thể xác định bằng 3Š trục X„. 
y„. z„ gán liền với khâu cuốt tại điểm E, hoặc bằng 3 thông số góc œ, 8. y nào 
đó. 


Giá trị của 3 toa độ xị. vụ. Z¡ và 3 thông số gốc ư. D, y đều phụ thuộc 
vào giá trị các biến khớp q, của cơ cấu fay máy. 


2) Lập trình điều khiển robot công nghiệp 


Trén hình 2.7 mỏ tà một sơ đồ lập trình điều khiển robot,cong nghiệp. 
Khi robot nhận nhiệm vụ thực hiện một quy trình công nghệ nào đó, ví dụ. 
“điểm tác động cuếi" E phải bám theo một hành trình cho trước. Quỹ đạo 
hành trình này thường cho biết trong hệ toạ độ Để các X,. yạ. z¿ cố định. Ở 
môi vị trí mà điểm E đi qua xác dịnh bằng 3 toạ độ đỉnh vị xị. Vụ, 2 và 3 
thông số góc định hướng œ, 8. y. Từ các thông số trong toa độ Đề các đó tính 
toán các giá trị biến khớp q, tương ứng với mỗi thời điểu t. ‡ là nội dụng 
bài toán động học ngược sẽ trình bày trong Chương V. Máy tính Ể glúp 
giải bài toán ngược đó. Rồi theo các giản đồ biến đổi q, (0), chương trình điều 
khiển tác động vào cơ cấu robot qưa các hé thống trợ động chấp hành như: bộ 
biến đối và khuyếch đạn tín hiệu, các van, các công tác hành, ›nh v.v. 


Quỹ đạo trong hệ toa độ 
tể các 
(Xz. Ve. Ze. 0œ, .Y) 


Ị A= ^ 
| Biến đổi từ toa độ Đề các | 
sang toa độ biến khớp q, | 


Chương trình điều khiển 


| Hệ trợ động chấp hành | 


¬ "* Các giản đồ Biến đổi q, 
@ 
= Quy trình công nghệ ị 


Hình 2.7. Sơ dỗ lập trình diều khiển 


2.4. HỆ TÓA ĐỘ VÀ VÙNG LÀM VIỆC 

L) Hệ toạ độ. 

Các chuyên động cơ bản của tay máy có thể hoạt động trong các hệ 
toạ độ khác nhau: 

Hệ toa độ trụ. RoboL Versatran của Hãng AME (Hoa Kỳ) là một 
trong những kiểu robot xuất hiện đầu tiên trên thể piới, cũng có chuyên động 
cơ bản hoại động trong hệ toa độ trụ nầy, 

Trong số nhiều loại robot cái tiến Versatran, có robot Fanuc M (Nhật 
Bán) giới thiệu trên hình 2.8. Trên thân đế có thân trụ quay góc 9. Chuyển 
động thăng đứng theo chiều Z và chuyển động hướng kính R được thực hiện 
bằng các bộ truyền vít đai ốc bì, Phần cổ tay được thiết kế để thực hiện các 
góc quay œ. | và y xung quanh 3 trục vuông góc. 


Hình 2.8. Fobot Facnue M hoạt động theo hệ toa độ trụ 


Hệ toa độ cầu. Loạt robot có các chuyển động cơ bản hoạt động 
trong hệ toa độ cầu, điên hình là loại Dmimate (của Hoa Kỳ) và các biến 


Immamnn .s 
Em 
Ì 


` 


Hình 2.9. Robot Uniuersal 


3 ? 


- 15 hoạt động theo hệ toa độ cầu. 
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thể của nó như là Kawasakl, Mitsubishi (Nhật Bản, Hoa Kì), Prab, Stanford 
tHoa Kỳ), Universal (Nga) v.v... Trên hình 2.9 là sơ đổ robot Univcrsal - 15. 
Các chuVên động cơ bản gồm: quay trên @, nâng nghiêng góc Ô và tịnh tiến 
hướng tính. Ngoài ra còn 2 chuyển động với góc xoay œ và ð ở phân cỏ tay. 


Hình 2.10. Fobot Shin Meiua PUU 752 hoạt 
` động theo hệ toa độ uuông dóc 


Hệ toa độ góc (hệ toa độ phóng sinh). 


Hệ toa độ vuông 
gác. Đôi với các loại robot 
hoạt động trong hệ toa độ 
vuông góc, các chuyến 
động cơ bản là các chuyển 
động tịnh tiến dọc theo các 
trục X, Y, Z. Trên hình 
2.10 là robot của Hãng 
Shin Meiwa PW 753 (Nhật 
Bản) dùng để hàn hồ 
quang. Ngoài các chuyển 
động cơ bản. thiết bị đầu 
bần có thể quay với góc 
xung quanh một trục lệch 
tâm và có thể xoay 
nghiêng góc ở. 


Đạy là hệ toa độ được dùng nhiều hơn cả. Ba chuyển động cơ bán 
đầu tiên đều thực hiện các nóc xoay (các góc tp. B: và B; trên hình 2.1L). túc 
là các chuyen dộng cơ hản được xác định bàng 3 góc xoay trong hệ toa độ 
gÓc. Ngoài thân quay với góc @. phản còn lại là cánh tay. gồm cánh 
tay trên quay vớt góc j};, cánh tay đưới quay với sóc Ð;, góc lắc bàn ray j3, và 
2 góc quay cổ tay œ; và ơi. Tất cả phản cánh tay đều nằm trên mặt phẳng 
thàng đứng nên các tính toắn cơ bản đều là bài toán phảng. Khí mát phăng 
này quay đi góc @, bàn kẹp có thế đạt tới bất kì vị trí nào trong vùng làm 
việc. Ưu điểm nổi bật của các loại robot hoạt động theo hệ toạ độ phòng sinh 
là gọn nhẹ, tức là vùng thaø tác lương đốt lớn so với kích cỡ của bản thân 


robot, 


Hình 2.11. obo!t hoạt động theo hệ toa đô phóng sinh. 


Trong số các loại robot hoại động theo hệ toa độ phỏng sinh nên kế 
đến các loại như Puma của Hãnp Unimation - Nokia (Hoa Kì - Phần Lan). 
IRb-6, IRb-60 ASEA (Thuy Điển), GDA - EKE (Đức - Phần Lan), Tosman - 
Toshiba, Mitsubishi, Mazak (Nhật Bản). Kuka (Đúc), Cincinnaty Milacron 
(Hoa Ki - Nhật Bản) v.v... Trên hình 2.12 là Robot Puma 760 với hệ toa độ 
phòng sinh. 


Hình 2.12 Robot Puma 760 uới hệ toa độ phòng sinh. 


2) Vùng làm việc 


Vùng làm việc của robot là khoảng không øian mà nó có thể thao tác 
được. 


ho: 
G3 


Trên hình 2.13 mô tả vùng làm việc của các robot Ilầib-6 và IRb-60 
của Hãng ASEA. ngày nay đã hợp nhất thành Hãng ABH. 


A AB CD E E Â 


B————D 2 1159 670 289 200 1620 1130 314 mm 
ẵ 2288 I28O 989 400 2150 J600 0 nơ 
mm 
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Hình 2.13. Vòng làm oiệc của Robot IRb-6 vua [Rb-6O 


Trên hình 2.14 là vùng làm việc của Robot Motoman của 
Hãng Yaskawa (Nhật Bản). 
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Hình 2.14. Vùng làm việc của robot Motoman 


Sự đa dạng của sản xuất đã thúc đấy sự ra đời nhiều loại robol mới 
kể cá các hệ roa độ mới, không hoàn toàn giống như các hệ toa độ đã kể trén. 
Ví dụ, trong những năm 80 đã xuất luện mội loại robot mới của Nhật Bản. 
vớt tên gọi là SCARA (Selecdvely Compliant Articulated Robot Arm) - tay 
máy mềm đẻo tuỳ ý. Loại robot này thường đùng để lắp ráp. rên SCARA đôi 
khi ma được giải thích là từ viết tất của “Selechve ComplUace Assembly 
Robot Arm”. Câu trúc động học của loại robot này cũng có thể xem như 
thuộc hệ toạ độ phỏng sinh. chỉ có khác là các trục quay của các khóp động 
đều thắng đứng. 


Lá 


iu Đo áo 


D)) 


Hình 2.15. Robot Skilam uà các uùng làm việc 
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Ngày nay có nhiều loại robot là biến thể của SCARA. ví như robot 
Skilam (Hãng Sankyo Seiki - Nhật Bạn). Adept - One (Hoa Kì). Sony, Nam 
lebo (Hãng Nahanishi - Nhật Bản) v.v... Trên hình 2.15 loại robot Skilam cố 
sơ đồ động (hình 2.15b) và các vùng lầm việc khi quay phải, quay trái hoặc 
quay cá hai phía, 


Trên hình 2.16 piới thiệu mội trong 5 loại robot được nghien cứu, 
thiết kế, chế tạo tại Trung tầm Nghiên cứu Kỹ thuật Tự động hoá, Đại học 
Bách Khoa - Hà Nội. Loại robot này ký hiệu là Robot RP. Chữ P để chỉ đặc 
điểm ở đây sử dụng cơ cấu Pamtograplh có 2 con trượt dẫn động như một 
modun cơ cau fav máy chuẩn hoá. Gọi đây là môđun chuẩn hoá vì từ đó có 
thể tạo dựng nhiều kiểu cơ cấu tay máy khác nhau. 


Loại hình cơ 
cấu tay máy này có 
các ưu điểm sau: Ị 


- Có thê bố 
trí nguồn đỏng lực 
gàn với thân tay 
máy nhưng vần đảm 
bio chuyển động 
độc lập của các 
khâu châp hành. 


Aqzx 422 


- Đám bảo 
đơn giản về kết cấu, 
lĩnh hoạt về cấu trúc 
và nhỏ gọn về kích 
thước. 


- Dễ dàng 
giữ cân bảng ở các 
vị trí khác nhau và ít 
tiêu hao năng lượng. 


- Dễ tính 
toán điều khiển do 
có thể thực hiện dễ 
dàng các chuyển 
dịch các con trượt 
tiếng rẽ và do các 
Đài toán động học 
đều có thể đưa về bài 
toán phẳng. 


Hình 2.16. Hobot EP 


46 


Trên hình 2.17 giới thiệu Robot SCA mm, do Trung tâm NCKT tự 
động hoá. ĐHBK - Hà Nội thiết kế. chế tạo. Robot SCA mini có 4 bậc tự do 
chuyển động. được thực hiện bảng các động cơ bước. 

2,5. CHÍ TIỂU ĐÁNH GIÁ VÀ CÁC THÔNG SỐ KĨ THUẬT 


Để các cơ cấu tav máy hoạt động lính hoạt tức là có thẻ thực hiện được 


Hình 2.17. Robot SƠA mini 
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dễ đàng các chuyển địch muôn màu muôn vẻ. chúng cần phải có một số bậc 
tự do chuyển động cần thiếL Như đã biết với các cơ cấu tay mấy dùng các 
cơ cấu hở không gian Có các khớp động loại Š thì số bậc tự đo Đằng số khâu 
đóng. Khi tăng số bậc tự do tức là tầng số khâu động và tăng số thiết bị động 
lực cho các khâu động đó nên sẽ tăng độ phức tạp về kết câu và chế tạo. Vấn 
để đặt ra là khi cùng số bậc tự do có thể chọn lựa cơ cấu tay máy nào đảm 
bảo tính lĩnh hoạt cao hơn. 


Tính linh hoạt cưa cơ cấu tay máy là một chỉ tiêu tổng hợp được thể 
hiện qua các Vếu TỔ sau: 


1) Độ cơ động của cơ cấu 


Như đã trình bày ở phản trên. ở mỗi điểm của quỹ đạo vị trí và định 
bướng tại "điểm tác động cuối” E của cánh tay robot được xác định bằng ố 
toa độ Xị. Vị. 2. @, B, y, Trong lúc mỗi cấu hình của cơ cấu tay máy được xác 
định bằng n giá trị biến khớp q¿ ... qạ. Số bậc tự đo n của cơ cấu tay máy có 
thể bằng hoặc khác 6. Có thể xảy ra 3 trường hợp sau: 


- Nếu n = 6, khi điểm E thực hiện đi chuyến nhỏ õx,,. Öy,, ÖZ,. Öa, Ö h, 
ỗ„ sang một v trí mới nào đó, thì có thể xác định ỗq,, ... Šq, một cách đơn trị. 


- Nếu n < 6 thì không phải lúc nào điểm E cũng đạt tới vị trí với định 
hướng như vêu cầu được. 

- Nếu n > 6 thì có nhiều lời giải để điểm E đạt tới vị trí với định 
hướng đã yếu cầu. 

Hiệu số n - 6 = m được gọi là độ cơ động của cơ cấu tay máy. Có thể 
xác định độ cơ động m bằng số bậc tự đo còn lại của cơ cấu nếu e!ữ cố định 
bàn kẹp lại. Ví dụ, trong trường hợp cơ cấu hình 2.4 nếu bàn kẹp kẹp vật ở vị 
trí cố định, tức là khâu 3 sẽ trở nên cố định và số khâu động còn lại là 2. Tính 
theo công thức (2.1) lúc này cơ cấu còn lại I bậc tự do (w = l). 


Sự tồn tại độ cơ động (m>I) là cé lợi vì khi đó cơ cấu tay máy có thể 
đạt tới đích với nhiều phương án khác nhau. Điều đó càng quan trọng nhất là 
khi môi trường làm việc có các chướng ngại. Tuy nhiên để có độ cơ động - 
cao, tức là cần số bậc tự do cao thì độ phức tạp kết cấu tay máy cũng táng 
theo và sẽ không tránh khỏi việc tăng giá thành và giảm độ chính xác chuyển 
động. 

2) Hệ số phục vụ. 


Trong vùng làm việc, tức là trong khoảng không gian mà bàn kẹp tay 
máy có thể thao tác được, không phải ở bất cứ điểm nào trong vùng này bàn 
kẹp tay máy cũng thao tác dễ dàng như nhau. Để đánh giá mức độ dễ dàng 
thao tác đó người ta dùng khái niệm hệ số phục vụ. 
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Hệ số phục vụ Šš là tỷ số giữa góc phục vụ ^2, so với 4 z. Góc phục vụ 
À là góc nón quét một vùng không gian mà chỉ ở phía trong đó bàn kẹp mới 


có thể hướng tới toa độ cần thiết. 


4 
Sh 


23) 


Giá trị của À. và š không những phụ thuộc vào vị trí điểm thao tác 
trong vùng làm việc, mà còn phụ thuộc vào kết cấu của tay máy, 


Hinh 2.18. Các giá trị ệ khác nhau trong 
uững làm uiệc của robot phưn sơn 


Trên hình 2.15 là kết quả tính 
toán trên máy tính các giá trị š ở 
các vùng làm việc khác nhau 
trong không gian hoạt động của 
robot phun sơn và được biểu thị 
bằng phần diện tích của hình 
tròn đơn vị. 


3) Độ dễ điều khiển của cơ cấu 
tay mấy 


Trong thực tế điều khiển hoạt 
động của tay máy, từ khí nhận 
được tín hiệu về định vị và định 
hướng của "điểm tác động cuối" 
E tại một điểm của quỹ đạo, cho 
tới khi điều khiển để đạt được 
mục tiêu đó, robot phải thực hiện 
hoại động đó trong một khoảng 
thời gian nhất định. Thời gian đó 
bao gồm thời gian tính toán để 


xác định các thông số điều khiển 


và thời gian thực hiện di chuyển. 


Tổng các thời gian đó có thê gọi 
là thời gian điều khiến. Trong đó 


thời gian tính toán giá trị các biến khớp q, theo các thông số định vị và định 
hướng tại điểm E, phụ thuộc vào loại cơ cấu tay máy, như sẽ trình bày trong 


chương Ÿ. 


Qua thông số thời gian điều khiển nói trên có thể xác định mức độ 
khó dễ điều khiến, như một chỉ tiêu đánh giá cơ cấu tay máy. 


4) Các thông số kỹ thuật của robot công nghiệp 


Robot công nghiệp thường được đặc trưng bằng bảng các thông số kỹ 


thuật cơ bản (xem bảng 2.1). 
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Hệ truyền đân động được ghi rõ là thuỷ lực, khí nén, động cơ điện [ 
chiều. động cơ bước v.v... Trong chương ÍX sẽ phân tích về khả năng ứng 
dụng các hệ truyền đẫn động này. Hệ điều khiển được xác định theo chu kỳ. 
theo vị trí hoặc theo chu tuyến v.v... Trong chương VI sẽ đề cập đến các hệ 
điều khiến ứng dụng trong robot công nghiệp. 


Sai số định vị của bàn kẹp A (mm) là độ sai lệch giữa vị trí thực so với 
vị trí yêu cầu. Mức chính xác thấp (A > + 1,0mm) áp dụng cho các loạt robơt 
vận chuyển, phun phủ v.v... Mức chính xác trung bình (0,Imm < À < 1.0mm) 
thích hợp với các việc như lắp ráp có khe hở, vận vít, hàn hồ quang v.v... Mức 
chính xác cao (A < 0,!mm) đùng khi đo lường, lắp ráp khít v.v... 

Bảng 2.1. Đặc trưng của robol. 


Thông số kỹ thuét nÌT, Giá trì 
Í sg bậc tự do - 
Tải nâng kg 
Giá ím giới han (max, min) 
* Biến khớp quay rad 
* Biến khớp tịnh uến mm 
Văn tốc góc lớn nhất khi quay rad/s 
Vận rốc tình tiến lớn nhất mm%& 
Tâm với (max / min) mam 
Tầm cao (max / min) mm 
SãI số định vì +mm 
Hệ truyền dân động - 
| Hệ điều khiển l : ] 


2.6. PHÂN LOẠI ROBOT CÔNG NGHIỆP 

Ngày nay robot công nghiệp đã phát triển rất da dạng. Có thể phân 
loại robot công nghiệp theo nhiều cách khác nhau: 

- Theo vị trí "công tác” phân ra các loại robot cấp thoát phôi, robot 
vận chuyển, robot vạn năng v.v... 

- Theo dạng công nghệ chuyên dụng phân ra các loại robot sơn, robot 
hàn, robot lắp ráp v.v... 

- Theo cách thức và đặc trưng điều khiển phân ra: robot điều khiển tự 
động, robot điều khiển bằng dạy học, robot điều khiển bằng tay, robot nhìn 
được (vision) V...V, 

- Theo các hệ toa độ được dùng khí thực hiện các chuyển động cơ bán 
phân ra các robot hoạt động theo hệ toạ độ trụ, cầu hoặc phỏng sinh v... v, 
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Bảng 2.2 thống kê các loại hình robot công nghiệp chủ yếu. 


Bảng 2.2. Robot công nghiệ 
Các loại Robot 


Toa độ vuông góc 


NG 
lân 
Tọa đô trụ 
\ 
P 
IR 


_". 


c Pu 


Hình trụ ` 


Toa đô cầu Hình cầu 


Tay máy phỏng 
sinh trục ngan 


IiaY Tay máy phỏng 


sinh truc đứng 


Hình cầu 


Tay máy con lắc Một phần hình cầu 


Tay máy phỏng 
Sinh n bậc tự đo 


5] 


CHƯƠNG II 
CÁC PHÉP BIẾN ĐỔI DÙNG MA TRẬN THUẦN NHẤT 


3.1. BIẾN ĐỔI TOA ĐỘ DÙNG MA TRẬN 
3.1.1. Vectơ điểm và toa độ thuần nhất. 


Vectơ điểm ( point vector ) dùng để mô tả vị trí của điểm (rong 
không gian 3 chiều. 


Trong không gian 3 chiều. một điểm M có thể dược biểu diễn 
bàng nhiều véctơ trong các hệ toa độ ( coordimale frame) khác nhau: 


Trong hệ toa độ o, x, y, z, điểm M được xác định bằng vectơ r,: 


T¡ = ( F „uy T1 ` Tội „ (3.1) 
và cùng điểm M đó trong hệ toạ độ o,x, y, z, được mô tả bằng vectơ Fị: 
=z - ¬-: 
f1 Tax#¿j) (3.2) 


Ký hiệu ( )Ÿ là biểu thị phép chuyển vị (Transporlation) vectơ 
hàng thành vectơ cột . 


Hình 3.1. Biểu diễn I diểm trong không gian 


Ở đây, cũng như về sau đều dùng các hệ toạ độ thuận, tức là, các hệ 
toạ độ chọn theo qui tắc bàn tay phải: nếu chọn ngón tay cái chỉ phương, 
chiêu của trục z, thì ngón tay trỏ chỉ phương, chiều của trục x và ngón tay 
piữa sẽ biểu thị phương, chiều của trục V. 


S2 


Véctơ r =(r,,ry.r,)' trong không gián 3 chiều, nếu được bố sung 
thêm một thành phần thứ 4 và thể hiện bằng một vcctơ mở rộng: 


T =(@r,,@Pr,,@r,@)'. (3.3) 


Thì đó là cách biểu diễn vectơ điểm trong không gian toạ đệ thuần 
nhất (homogeneous coordinafe). 


Dưới đây để đơn giản hoá, ở những chỗ không gây nhầm lẫn, có 
thể bỏ quá ký hiệu ( ~ ) đối với vectơ mở rộng (3.3 ) 


Các toa độ thực của véctơ mớ rộng này vẫn là: 


TL, = Ty = F, _ (3.4) 


Không phải duy nhất có một cách biểu diễn véctơ trong không 
gian toa độ thuần nhất. mà nó phụ thuộc vào giá trị của œ. Nếu lấy œ = ] 
thì các toa độ biểu điễn bằng toa độ có thực. Trong trường hợp này véctơ 
mở rộng được viết là: 

E=" (ifpy407v6LE (3.5) 
Nếu lấy œ # l thì các toạ độ biểu diễn gấp œ lần toa độ thực, nên có thể 
gọi @ là hệ xổ rý lệ. Khi cần biểu điễn sự thay đổi toa độ kèm theo có sự 
biến dạng tỷ lệ thì dùng œ z 1. 
3.1.2. Quay hệ toa độ dùng ma trận 3x 3 


Trước hết thiết lập quan hệ giữa 2 hệ toạ độ XYZ, và UVW chuyển 
động quay tương đối với nhau khi gốc O của 2 hệ vẫn trùng nhau 
(hình 3.2). 


Hình 3.2. Các hệ toa độ. 
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Gọi (Ì,,1.L}) và \ Ì,.Ï,, lv ) là các vectơ đơn vị chỉ phương các 
trục OXY Z2 và OƯVW tương ứng. 


Một điểm M nào đó được biểu diễn trong hệ toạ độ OXYZ bằng 


vectơ: 
` Tự =8) (3.6) 
còn trong hệ toa độ OUVW bằng vectơ: 
Fuyy E (TU, TQ, Ồ (3.7) 
Như vậy: 
TY =wv= TẢ, + trị, + ryk„ ị (3.8) 
F=Ty, = n4 + nấy trực, 


Từ đó ta có 


r,=i LÝ = Ly + Í + Kựr, 
Ty = Ỷy t~ đu, + J4 + JRtv (3.9) 
r,=kK,r= K,lr,+ K/}r, + k,K¿r, 


Hoặc viết dưới dạng ma trận: 


lọ LU đỊ, 1K, Tụ 
Ê 2! điện: SIM: 2e: 2E ve 6á (Pu (3.10) 
Tp kủ, kạj,, k„k, HỆ 


Gọi R là ma trận quay (rotation) 3x3 với các phần tử là tích vô 
hướng 2 vectơ chỉ phương các trục tương ứng của 2 hệ toạ độ OXYZ, và 
OUVW. 


Vậy (3.10) được viết lại là: 
Tyy, = R.ryy 
An (3.11) 
Có thể biểu điễn các phần tử ma trận R và R'” như sau: 
COS(x,⁄) CoS(X,v) cOS(x,W) 
R= [[2, ]]=|cos(y,) cos(y,v) cos(y,w) (3.12) 
COS(Z,) C©S(Z,v) C0S(Z,W) 
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COS(⁄,x) cos(w,y) cOS(/,Z) 
l 
⁄ =[[P,l]=| cosw,x) cos(v,y) cos(,Z) | (313) 
COS(w,x) COS(W,y  cOS(W, z) 
Chú ý đến quan hệ giữa 2 cặp trục, ví dụ, cos (x,u) = cos (u,X) v.V... 
dễ dàng nhận thấy. 
Rhe§ (3.14) 
Ký hiệu ( }ˆ là biểu thị ma trận nghịch đảo 
và ( )” là ma trận chuyển vị (Transported) 
3.1.3 Biến đổi ma trận dùng toa độ thuần nhất. 


Bây giờ thiết lập quan hệ giữa 2 hệ toạ độ: hệ toạ độ o,X, V, Z, sang 
hệ toa độ mới o,x,y,z,. Chúng không những quay tương đối với nhau mà 


tịnh tiến cả gốc toa độ: gốc o, xác định trong hệ x,y, bằng véctơ p: 
p = (a,-b,-c,1)” (3.15) 


Giả sử vị trí của điểm M trong hệ tọa độ x, y, z được xác định bằng 
VẾCtƠ T/ 


r,=( X, 2,1) (3.16) 
và trong hệ toạ độ x, y, z, điểm M được xác định bằng véctơ r,: 
r.,=(x,yz..U” (3.17) 


Từ hình 3.3 có thể dễ đàng thiết lập mối quan hệ giữa các toạ độ: 


* 


Hình 3.3. Các hệ toa độ 
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X,.= Xtat, 

Yy, = ÿ,COSO - 2 SH -bt, (3.18) 
Z, = Y, SIQ + Z/COSO - CỤ 

(l=t =l 


) 
Sắp xếp các hệ số ứng với x,, Y,, Z, và t thành một ma trận: 
| 0, 0 a 


_ |0 cosø —sino =b 


Ô sn@ cosọ -c (3.19) 
0 0 0 | 
và viết phương irình biến đổi toạ độ như sau: 
r.= Tụ, (3.20) 


Ma trận T, biểu thị bằng ma trận 4 x 4 như phương trình (3.19) và 
gọi là ma trận thuần nhất. 

Các vectơ (3.15) .(3.!6), (3.17) là những vectơ mở rộng biểu diễn 
trong không gian toạ độ thuần nhất. Có thể viết cụ thể lại (2.20) hoặc 
(3.18) như sau: 


Ẩ, | 0 0 Di X) 

Ý, = 0Ô coso -sInp  =b "mm. (3.21) 
z, 0 sing COSĐ -C 2 

I 0 Ô l§ l | 


Như vậy ma trận thuần nhất 4 x 4 dùng để biến đối véctơ mở rộng 
từ hệ toa độ thuần nhất này sang hệ toạ độ thuần nhất kia. 


Ứng dung ma trận thuần nhất trong phép biến đổi toạ độ tỏ ra có 
nhiều ưu điểm. bởi vì trong mu trận 4 x 4 bao gồm cả thông tin về sự 
quay và cả về dịch chuyến tịnh tiến. 


Phương trình (3.20) mô tả sự biến đổi từ hệ toạ độ cũ o, x, y, z¡ sang 
hệ toa độ mới o, x, y,z,. Khi cần biến đổi ngược lại ta có. 


Tết s1, vi (3.22) 
với Ti TU (.23)- 
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Ma trận nghịch đảo T,'' được tính từ T, theo công thức (3.24): 


l 0 0 -a ì 

KI 0 COS@p  SIn@ bcos@ + csine 
0 -SINP  cosọ — -ÐsInp + ccos@ (3.24 
0 0 0 ] 


Có thể thiết lập công thức này theo cách sẽ trình bày ở phần sau, 
khi suy diễn công thức (3.33) hoặc (3.34). 
3.1.4. Ý nghĩa hình học của ma trận thuần nhất 


Từ (3.19) nhận thấy ma trận thuần nhất 4x4 là một ma trận gồm 4 
khối: 


l 0 aà 
C0S@ -sIno ; -b 
T,= sing cos(qp ¡¡ SỆ (3.25) 
0 0 | 
Hoặc viết rút gọn là: 
T,= b2): 200 XI (3.26) 
0G. 


Trong đó: 

R„ - ma trận quay 3x3 

p - ma trận 3xl biểu thị 3 toạ độ của điểm gốc hệ toạ độ o, trong 
hệ toạ độ O, X, ý, Z : 

x3 - ma trận không 


1x†1 - ma trận đơn vị 
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Như vậy ma trận thuần nhất 4x4 là ma trận 3x3 mớ rộng. thêm ma 
trận 3x1 biểu thị sự chuyển địch gốc toạ độ và phần tử a„; biếu thị hẻ số 
tỷ lệ. 
Để đàng nhận thấy ma trận R„ chính là ma tràn quay 3x3, nếu suy 
từ ma trận quay trong (3.10) sang trường hợp hình 3.3 ta có: 
€OS(X,,Xj,)  COS(X.,y,)  COS(X¡, Z4) 

R„= [ay |= | cos(y¡,X;) cos(CV,,y,)  cos(y,,2¡) | (3.27) 
COS(2,,X.) COS(Z¿.V,)  COS(Z/, 7) 

và các góc cosin chí phương này đều liên hệ đến góc @ (hình3.3). 


Nếu chú ý về quan hệ giữa 2 cặp trục, VÍ đụ, cOs(x; y) = cOs (y, X,) 
v... v. ở đây dễ dàng nhận được biểu thức tương tự (3.14): 


R, = Rự = R„ (3.28) 


Mô tả tổng quát hơn nếu một điểm M nào đó được xác định trong 
hệ toa độ thuần nhất ỦUVW bằng véctơ mở rộng r„„, thì trong hệ toa độ 
thuần nhất XYZ điểm đó được xác định bằng vectơ mở rộng F,v„ 

Tu, = TTụ. 4.29) 

Trong đó T là ma trận thuần nhất 4x4, có thể viết khai triển ở 

đạng sau: 


Ụ Šx 4y ị p X 
Hy %y 3y Py 
dế | chà S2 Âu lờ ý (3.30) 
0 0 Ö | 
hoặc R ị p 
đệ,  scEbi le sùs (3.31) 
A. 
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Ta tìm hiểu ý nghĩa hình học của ma trận T. Như đã trình bày khi 
phân tích các khối của ma trận 4x4, ma trận 3x] tương ứng với toa độ 
điểm gốc của hệ toạ độ UVW biểu diễn trong hệ XYZ.. 


Nếu 2 gốc toạ độ trùng nhau thì các thành phân của ma trận 3x1 


này đều là 0. Khi đó xét trường hợp: 


r„„=(1,0.0./1)7 


tức là ru, 
thì dễ đàng nhận thấy cột thứ nhất hoặc véctơ n của ma trận (3.30) chính 
là các toạ độ của véctơ chỉ phương trục OU biểu điễn trong hệ toa độ 
XY”Z. 

Tương tự khi xét các trường hợp 


r„„=(0, 1,0,1) 


` 


và r„„=(0, 0. 1,1)! 


cũng đi đến nhận xét cột thứ 2 (hoặc vếctơ s) ứng với các toa độ của vectơ 
chỉ phương trục ÔV và cột thứ 3 (hoặc véctơ a) ứng với các toạ độ vcctƠ 
chỉ phương trục OW, 


Như vậy, ma trận thuần nhất T 4x4 hoàn toàn xác định vị trí và 
định hướng của hệ toa độ UVW so với hệ toạ độ XYZ. Đó là ý nghĩa bình 


học thứ nhất của ma trận thuần nhất 4x4. 


Ma trận nghịch đảo T' có thể xác định theo các cách sau đây: 

Gọi tổng quát các phân tử ma trận T và T" là [a, ] và [b, } tương 
ứng, với ¡ = j = l+ 4 và chú ý rằng từ (3.14) đối với ma trận quay bậc 3x3 
đã có R ` =R”. Do vậy có thể viết khai triển phương trình T*. TT = I( ma 
trận đơn vị) như sau: 
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âu đại 8, Ö 000 ba Ï äa A¿ â; Ô 0 00a, 
ID số AC 000bồ, Sị Để đà ĐI I| ĐH 49 âu 
ây ây; a;; 0 0 00b.l la, a; 4; Ô 000a„ŸP1 
0 000 0001 0 090 000 l1 
Sau khi biến đối ta có: 
Địa = - ( âuy4,¿ † aá;¿ + âu ) 
bạụ=<:(ã, say # đụng; # tá) (3.32) 


bạ = - (d,yáy¿ + Aa;8;¿ + Ay/1¿ ) 


Từ đó để đàng thiết lập các công thức sau đây để tính ma trận 
nghịch đảo T” 


R' -. -Rp 
Tz | J—Em cm (3.33) 
0  Í 
RẺ. -RPp 
T bế: +] 2050286 agi bi. /lA eo (3.34) 
0 : ' 
;pm 
T'= | RỦ '.ps (3.35) 
: -p 


Trong đó các tích vô hướng véctơ ; 
p.n=p,n, + pm, + pm, 
P.S= PS, † D5, + D5, (3.36) 


p-A = Đyâ, + Đy4y +pA, 


Như vậy trong ma trận nghịch đảo T ” thì các cột 1,2,3 tương ứng 
với các toạ độ của véctơ chỉ phương các trục OX, OY và OZ biểu thị 
trong hệ toa độ UVW, Còn 3 thành phần đầu của cột thứ 4 ứng với các 


ó0 


toa độ của điểm gốc XY”Z trong hệ toạ độ UVW. Ý nghĩa hình học đó 
cũng có nhiều ứng đụng thực tế, 

Ngoài ra. từ (3.36), có thể thấy, nếu phương trục nào đó (ví đụ, 
OU) của UVW thẳng góc với véctơ p, thì phần tử tương ứng ( ví dụ, phản 
tử đâu) của cột thứ 4 sẽ bằng 0. Trường hợp tất cả 3 phần tử của cột thứ 4 


bằng Ô là lúc 2 gốc toa độ trùng nhau. 


Trong các phần tử sau khí sử dựng ma trận thuần nhất 4x4 sẽ khai 


thác thêm các ý nghĩa hình học tiếp theo của nó. 
3.3. TÓM TẮT NỘI DƯNG CƠ BẢN VỀ MA TRẬN. 
3.2.1. Các định nghĩa. 


Ma trận À bậc m x n là một bảng số: 


#nị Ẩn se địn 
đại 32; «độn 
A={a,]|= : 
đm Ân ạt “linn 
t= L2... m 
J=12,....n 
a,,~ các phần tử của ma trận ` 
m - đồng 
f1 - CỘI 


Khi m = Ï -> ma trận Ì dòng 
n= l -> ma trận Í côi 
Ma trận I dòng hoặc ma trận ! cột thường dùng để biểu thị vectơ. 
Ma trận chuyển vị của ma trận A là ma trân A` CT - transpoited : 


chuyển vị), đã chuyển vị trí của cội thành bàng và ngược lại. 


6l 


an đại sa đây N 


ÄI2 3a; hàn oÊg Ân 


§ đạn ân nhy đụ 
j~Z⁄ 


1=1,2,...,n;]=1/2,...,m 


AT= 


Vậy ma trận chuyển vị của ma trận ] đồng là ma trận l cột và 
TIEƯỢC lại. 


Ma trân vuông (bậc n) khi m = n, 
Ma trận đường chéo (bậc n): 
a,=0khiizj. 1= 12,....n 
Ma trận đơn vị (bậc n), ký hiệu là T (Inđdentttv Matrnx) 
A,=0Okhilzj. tlị=l,2....n 
a,=Lkhii=l Lị=l,2....n 
Ma trận đối xứng vuông (bậc n): 
Á=A 
tức là ả,= -d, — VỚI mọi ì Và J 
Ma trận đối xứng chéo vuông (bậc n): 
A=-A' 
tức là au,=-d, Và ay=Ô0 tLj= 1/2/...n 
Một ma trận không đối xứng À bất kỳ có thể biến thành ma trận 
đối xứng bằng cách: 
C=(A+A 32 
Ma trận không O0: a,=9 
Ma trận bằng nhau: A=B 
tức là a, =b„ VỚI mọi ï và j. 
3.2.2. Phép cộng, trừ ma trận: 
Cộng (trY) các ma trận A và R cùng bậc sẽ có ma trận C cùng bậc 
với các phần tử c„ là tổng ( hiệu) các phần tử a, và b„ với mọi ¡, j: 
A+B=C tứch au + bu = Cụ | 
A-B=C tức là au- Đụ =Cụ 
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Phép cộng ma trận có đầy đủ các tính chất của phép cộng số thực: 
l)A+BE=EB+A 
2)(A+B)+C=A~+(B+C) 
3)A+0O=A 
4)A+(-A)=0 


3.2.3. Phép nhân ma trân: 


Nhân một số (vô hướng) k với ma trận À: 
k.A = Ak =[ ka,] = [a,k] 
¡= 1,2,...,m 
J=1⁄2...,n 


Phép nhân ma trận (bậc bất kỳ m x n) với số vô hướng a hoặc b 
tuân theo các qui tắc sau: 


l)a.(A+B)=aAvaB 
2)(a+b).A=a.A +b.A 
3)a (bÄ) = (ab) Á 
4)LA=A 


Hai ma trận có thể nhân với nhau cÖŸ ki số cột của ma trận này 
bằng số dòng của ma trận kia: 
CA ta) ( B.„y ) = Cu 


ụ 
TUỆ 2.20, 


Qui tắc "nhân dòng với cột" có thể phát biểu như sau: 


Để xác định phần tử cụ của ma trận C = A.B cần từm tổng của tích 
các phần tứ trên dòng thứ ¡ của ma trận A nhân tương ứng với các phần 
tứ trên cột thứ J của ma trận B. 


Sơ đồ dưới đây minh họa cho qui tắc "nhân dòng với cột ": 


á3 


41 


Cụ CC Cịy 
“hố.  s. 
Lfay|] Cạy su 
: 


42 Cạy Cá 


Cụ = AiÐj; + Aaba; + Ay;Ði, + 4Ðị; 


Phép nhân ma trận không có tính giao hoán (commulability): 


AÁ.B+xB.A 


Ma trận đơn vị giao hoán được với bàt kỳ ma trận vuông nào: 
LAE=A.IEA 
Phép nhân ma trận tuân theo các qui tắc sau: 
I) Œ&.A).B= k/(A.B) = A.(k.B) 
2) A.(B.C) =(A.B).C 
3) (A+B),C = A.C+ B.C 
4) C(A+B) =CA+CB 


3.2.4. Đinh thức của ma trận ( determinant of a matrix) 


Định thức của ma trận A bậc n x n, viết là: 


ni 
ä; 
lA|=|; 


Ađịy 


4a âu an | 
8y; đạy đau 

` : hoặc đet À 
Ân đạn đu 


và bằng tổng của tích các phần tử nhân với phần phụ đại số tương ứng: 
|4|=2›;2„4, PP 4, 
„lì ;Ì 
với À.„ - phần phụ đại số tương ứng với phần tử a,, 


Au= ( 1 lo M, 


với M, là định thức con (mtnor) nhận từ định thức | A| bằng cách bỏ các 
-_ phần tử trên dòng thứ ¡ và cột thứ j. 
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đặn MP) đu Quay địạ 
a ..q h a đà$ 
LẦN! }219 ;+1,/+| ¡T17 +Ì ¡-Ì.n 
IM,| = 
đi đu 2> đ,.¡ + a “N 1+Í,H 
đmn đụ c« đựn¡ đi đưn 


Như vậy, định thức bậc n phụ thuộc vào n định thức bậc n-l: mỗi 
định thức này lại phụ thuộc vào n-l định thức bậc n-2 và cứ thế đến định 
thức bậc Ï (là một số vô hướng). 

Đối với các định thức bậc 2 và bậc 3 có thế dùng phương pháp 
đường chéo đơn giản. 


Ví dụ, với định thức bậc 2: 


ân — 32 
| Al= = âtrâ›; - 32i44; 
3 82; 
với định thức bậc 3: 
ây(c 3a âu 
|AIE |ân 2s “—-......à 
đại ñ; âu 


BS. ........ ._. kh... 


Để đơn giản việc tính các định thức người ta dùng các tính chất, ví 
du như: 


1. Nếu tất cả các phần tử trên một dòng (hay cột) bất kỳ của ma 
trận A mà đều bằng 0 thì | Ai = 0. 


2.|AI=|A' 


3. Nếu 2 dòng hay cột bất kỳ của ma trận A mà đổi vị trí cho nhau 
thì sẽ thay đổi dấu của định thức. 


4. Nếu các ma trận A và B đều là bậc n thì | AB = | A|. | BỊ. 


5. Nếu tất cả các phần tử của dòng (hay cột) bất kỳ của ma trận A 
đều được nhân với một số vô hướng k thì giá trị của định thức sẽ tăng lên 
gấp k lần. 
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Nhận xét: Cũng tương tự như định thức, ma trận có các phần tử xếp 
thành đồng và cột, nhưng không tính ra băng một số như định thức. Chỉ 
có ma trận vuông mới có định thức. 


3.2.5. "Rang" của ma trận, 


Nếu bỏ bớt trong ma trận A một số đồng và một số cột sao cho số 
đồng và số cột còn lại bằng nhau thì phần còn lạt là định thúc con (minor) 
của ma trận A. Một ma trận có thể có nhiều định thức con (minor), Trong 
số đó có các định thức con bằng không. Số bậc cao nhất của định thức 
con được goi là "Rang” của ma trận. 


Rang của ma trận rnxn, với m z n, sẽ không vượt quá số nhỏ trong 2 
SÔ m và n, 


Dùng khái niệm Rang có thể xác định điều kiện cần đủ để hệ 
phương trình tuyến tính có số phương trình bằng số nghiệm, là: Rang của 
ma trận hệ số bằng Rang của ma trận hệ số mở rộng, 


3.2.6. Vết của ma trận ( Tr - Trace). 


Vết của ma trận vuông bậc n là tổng các phần tử trên đường chéo: 
Ui 
Tr(A)= À4, 
¡zÏ 


Mội số tính chất quan trọng của vết ma trận: 
Ù) Tr (A) = Tr (A”) 
2) Tr (A+B) = Tr (A) + Tr (B) 
3) Tr (A.B) = Tr(B.A) 
4) Tr (ABC?) = Tr (CBTA") 


3.2.7. Ma trận nghịch đảo. 


Ma trận nghịch đảo của ma trận A dược ký hiệu là A' thoả mãn 
phương trình sau: 


A'A=AA'=l 


Từ đó ta có: 
đet A. đet (A')) = đet Ì =1 
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vậy 
đet (A ”)= l/ đẹt A 
Rõ ràng phải có điều kiện: đet A + Ö. 

Ma trận có định thức băng không gọi là má trán suy biến. Ma trận 
suy biến không có ma trận nghịch đảo và các ma trận không suy biến đều 
có ma trận nghịch đảo. 

Như đã ký hiệu A,„ là phần phụ đại số ứng với phần tử a, của ma 
trân A. Dê dàng kiếm nghiệm biểu thức sau: 

Ị 
_ đet4 +4, 
|A,] - ma trận với các phần tử A,. 
Các tính chất: 
(A/Ai.;.AjJ '?EBÄy Ai: AC 
LÀN I\ SA: An loyaQÃc VÀO” 
(AĐTAT=(AA?Đ'=1Il  dođó(A'J=(A! 
(A'+BTICB)' = A - ABT( BABT +C]})! BA. 


Một số công thức sẵn: 


{. Trường hợp 2x2: 


a —€ Ị d - 
Á= — À'= —— 
b d ad - be -b a 


2. Trường hợp 3x3: 


| 
= .  ÖẶ——— 
ae + dhc + gfb — a‡h-dbi — gec 


(ei-fh) -(bi- ch) (b - ce) 
X -(di-fg)  (ai- cơ) -(af - cd 
(dh-ge) -(ah-bg) (ae - bđ) 
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3.2.8. Vi phân và tích nhân ma trận. 


Nếu các phần tử của ma trận À là các hầm (ví dụ của thời gian 1) 
vi phân được, thì tồn tại đạo hàm của ma trận. Đó là ma trận với các phần 
tử mới nhận được bằng vi phân các phần tử của ma trận A. 


Cũng có các công thức sau (A,B là ma trận cùng bậc; X là ma trận 
không phụ thuộc £) 


#(AB)= 4B+ 4B 
đi 


Sửi AX TU 2 
di đi 


Tương tự, phếp tích phân ma trận cho một ma trận: 
[4œ)“ =t 4 (0)4) 
và cũng tuân theo các qui tác: 
DÍ(A+B)dt = Í Adt + Í Bát 
2) Í AXát = (ÍAd0X 
3.3. CÁC PHÉP BIẾN ĐỔI CƠ BẢN 


3.3.1. Phép biến đổi tình tiến 


Từ (3.19) hoặc (3.30), biểu thị ma trận thuần nhất, khi chỉ có biến 
đổi tịnh tiến mà không có quay (@ =0), ta có: 


l0 0 p, 
0 10p, 

“.. : B2 2U. 
0 00 1 


Đó là ma trận biến đổi tình tiến (Translation). 


Gọi u là vectơ biểu diễn một điểm (trong không gian) cần dịch 
chuyển tịnh tiến: 


u=(x,y,z)” 
và p là vectơ chỉ hướng và độ dài cần dịch chuyển: 


P=(P,.Py.p,)` 
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thì v là vectơ biểu diễn điểm toạ độ trong không gian đã được tịnh tiến 
tới: 


v=T,(p,.p,.p,)u (3.38) 
Ví dụ: Chobiết u=(2.3,2 )Ì 
p=(4.-3.7 ) 


cần xác định v. 
Giải. 
Theo (3.38) ta có: 


10 II lễ 6 
v=T,(p,,py,p,)u= ụ lệ x : = : 
0 0 7| 2 9 

0 0 0 1 Ị | 


Hình 3.4. Phép biến đối tịnh tiến trong không gian 
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3.3.2. Phép quay quanh các trục toa độ . 


Từ ma trận quay 3x3 trong biếu thức (3.10) ta xây dựng ma trận 
R (x. œ) cho trường hợp hệ toa độ UVẮW quay quanh trục ÔX một póc œ 
nào đó. Trong trường hợp này Ì, = Ï„ 


| 0 0 0 
`... 0 TềP —=snøz 0 
0 sinz cosz 0 G.39) 
0 0 0 Ỉ 
Tương ứng cho ftường hợp quay quanh trục ÔŸ một góc ọ: 
cos? Ø sino 0 
| 0 0 
PT -sino 0 cosgp 0 G.40) 
0 0 0 1j 
và trường hợp quay quanh trục ØZ một góc 6: 
cosØ -sinØ 0 0, 
R(z,8)= snØ cosở 0 0 
0 0 I 0 4) 
0 0 0 1 


Cột thứ 4 của các ma trận 4x4 trên có 3 phần tử đầu đều bằng 0 vì 
ở đây không cố sự tịnh tiến. Các ma trận này được gọi là các ma trận 
quay (rotation) cơ bản. Các ma trận quay khác có thể xây đựng từ các ma 
trận cơ bản này, 


Ví dụ: Cho điểm U biểu diễn bằng vectơ u; 
u=(7,3,2)' 
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0 -1 0 0]l7| [-3 
0 0 0|3 ï 

V= R(z,90) = = 
0 0 1 0|Ìl2 2 
|0 0 0 IÌI 


quay quanh trục Z một góc 90° (hình3.5) để tới điểm V xác định bằng 
V€ctơ V. 


Giải: Nếu cho điểm V tiếp tục quay quanh trục y một góc 90” tới 
điểm W, xác định bằng véctơ W. 


0 


Yử = R(y,90)V= 


| 
© CC — C 
© © c — 
— ©C C C 
— 2 1l 


Có thể biểu diễn: 

w=R(y,90).R (z,90)u=(2,7,3, D' 
Chú ý: Nếu đổi thứ tự quay sẽ được w # w. 
Rõ ràng là: R(y, 90). R ¿z, 90) u z R (2z, 90). R (y, 90) u. 


Thật vậy, như chỉ rõ trên hình 3.6, cho Ù quay quanh trục y trước 
một góc 90”, ta có: 


0 010 ñ) 2 
v =R(y,90)u = | li Tin 
=1 0 0 011/2 _—7 
0 0 0 1 ' | 
Sau đó cho v quay quanh trục z một góc 90”, ta có: 
¡0 —1 0 0l 2 -3 
w_= R(z,90).R(y.90)u = H dể cán cải l|PE : 
0 0 I 0l-7 —7 
0 0 0 T1Ị 1 | 
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^2 
~Z 


kề, 
kớể.¿ 


x»> 
Hình 3.5. u = R(u,90% R(z,90°)u Hình 3.6. u; = R (2,90). R y,90°)u 


3.3.3. Phép quay phức hợp. 

Hệ toa độ OUVW gắn với một vật thể nào đó được quay tương đối 
so với hệ toa độ cố định OXYZ, và có thể hợp thành từ 3 chuyển động 
quay hiến tiếp quanh 3 trục OX, OY, Õ⁄2 với góc quay tương ứng là ơ, Ö, 
tỌ. 

Ba phép quay cơ bản này được biểu thị bằng các ma trận (3.39), 
(3.40), (3.41) tương ứng, Vậy ma trận biểu thị sự quay phức hợp này là 
tích của các ra trận quay cơ bản nói trên. Cần lưu ý răng phép nhân ma 
trận không có tính giao hoán nên trình tự các phép quay cơ bản phải được 
đảm bảo. 

Ví d„: Nếu quay theo thứ tự thực hiện góc quay œ, Ö rồi sẽ có: 

R(œ,9,ø)=R(y, 6) R (, 8) R (x, œ) (3.42) 
thay (3.39) + (3.41) vào (3.42) ta có: 


Ki Sg. Su9a/~CaOuEo> ' CuOúSg ga 


( `“Œœ 
RÍ lội ) à CọC, —ChŠ„ 0 
qAU,G)= 
h S5 Cục uoiGe 1 CuSs, (Cu =SusáCzs 0 (3.43) 
l Ú 0 0 1j 


Ở đây cũng như vẻ sau dùng cách viết tắt ví dụ: 
Cạ = cos(p „3a NI, h.uV. 


Nếu trình tự các phép quay cơ bản thay đổi đi: quay @ quanh OY, 
quay Ö quanh ỞZ, rồi quay œ quanh ÔX. ta lại có 
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R (œ,9.0)=R(,oœ).R(z.9)R(y.oœ) (3.14) 
Cu a Sạ CS, 
l0, +S „5S, CuC¿ CS no ST 
Su5¿C So se Sub, S0 VÊc 


0 0 0 
3.3.4. Phép quay quanh trục bất kỳ. 


R(o,Ô,0)= 3.45) 


— © C CC 


Trong nhiều trường hợp tọa độ động OUVW gãn liền với vật thể 
nào đó có thể quay góc ( quanh một trục bất kỳ nào đó cất qua gôc O, 
đặc trưng bằng vectơ đơn vị chỉ phương: 


FS(tf.1E 0V} (3.46) 


Hình 3.7. Phép quau quanh trục bất kù 


Để xây dựng ma trận R(, @) biểu thị sự quay của vật thể quanh 
trục quay r. có thể thực hiện qua các bước sau (hình 3.7): 


- Quay góc œ quanh OX, để trục r sẽ nằm xuống mặt phăng XZ⁄. 


- Quay góc - quanh OY, để trục r (đang nằm trên mặt phẳng XZ) 
sẽ trùng với trục Ô⁄2. 


- Quay góc @ quanh trục r (đang trùng với O7). 

- Quay ngược lại qua bước quay +] quanh trục OY. 
- Quay -œ quanh OX để đưa trục r về vị trí xuất phát. 
Vậy ma trận Rír, @) sẽ có đạng sau: 


Rứ, @) = RŒ, -œ). R(y, 6B). RŒ, @). RŒ, -B). R(x, œ) (3.47) 


VỚI: 
1 0 0 0 
R(x,—œ) = 
0 —S§, €C. 0 
00 0 ¡ 
_C€c 0 s5, 0 Ca Ú 0| 
RŒ8j= 0 1 0 0 Ñt dÿ= ` „0 0, 
là S, 0 €; 0 0 0 ¡0 
0 0 0 1 0 0 1 
Cạ 0 5, 0 1 Ø0 0 0 
0 1 0 0 C„¿ -S§, 0 
R(y.~B)= l 0C, .Ñ(x,œ) = 3 W Ð 
L9 .0 90 1) 0 0 0 | 
Từ hình 3.7 ta có: 
sind=r/(th+r,))” cosœ=r/tr+r/)” 
sin B =r, cọ B = (ty +r2)!2 
và gọi: Vự = Vers @ = Í-cos@, (versim @) " 
EA CÓ: 
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rẻ +, KV EY oy sđyip Vẽ By ' vÚ 
| Mh TẠI 0Ÿ) r „+, C0 0n ẤN, 

9 lry PP {rS, ruV +r5, rˆYP +C,  0|489 
0 0 0 l 


Ví dụ: Xấc định ma trận quay Rír, @) quay góc @ quanh trục r: 
r=(1,1.1) 


Giai: ở đây vectơ Y không phải là véctơ đơn vị nên các hình chiếu 
xác định như sau: 


| | 
* sWã = thi 
thay chúng vào (3.48) ta có: 


] | ] | ] ' 
—V +€ —V =5, -=V + S ÔÖ 
3 @ BÉ 3 @ Xã “ 3 Mu .Jã tp 
] | l ] 
RŒ,0)= Bài SN HA, 3Ý, tC, 3 v0 TT 0 
l | l l ] 
—=VW -——SŠp —V +-—Š —V +C 0 
3 õ x3 p 3 bu 33 ạ 3 ạ ọ 
L 0 0 0 ] 


3.3.5. Phép quay theo 3 góc Puler. 


Ta biểu 
thị sự quay của 
vật thế thông 
qua các góc 
Euler. Có 
nhiều cách 
định hướng 
bằng 3 góc 
Euler. Dưới 
đâyv là cách 
thườnp dùng 
nhất (hình 3.8): 


Hình 3.8. Phép quay theo 3 góc Euler 


75 


1) Quay góc ó quanh trục zZ. 

2) Quay tiếp góc 8 quanh trục y mới, đó là y. 

3) Quay tiếp góc \ quanh trục z mới, đó là z và ma trận biểu điễn 
phép quay theo 3 góc Eulcr, gọi tất là phép quay Euler nhận được bằng 
cách nhân 3 ma trận quay với nhau. Ở phép quay Enler nếu thực hiện thứ 
tự quay ngược lại (->Ö—>¿) cũng cho kết quả như nhau: 


R(¿.9,P) = R (z, @). R(y, 8). R(z, ) (4-40) 
Œ, =5, 0 0 
R&,ø=|Š* C„ 0 0 
Z 2; = 
báo: ° St viấy ¬4 
00 01 
Có.> S26 40 
Xi | Sn. vú) Sộ 
; = 
-Ñ8, 0 Œ, 0 
0 0 
Cự -Šy 


Rz.w)=| lý ở 


Thay vào (3.49) ta có: 
C,C;C„~Š,S„, —C,C¿S,—$,„C„ %0} 
SG, ty, 0y, +CVC, §Ấy- 0 
—%,C, Suẩy Œ,_ 04359) 
0 0 Ñy: FÍ 


R(j,2.)= 
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3.3.6. Phép quay Roll - Pitch - VYaw (RPY) 


Một phép quay khác 
cũng thường được sử dụng là 
phép quay Roll, Pich và 
Yaw, gọi tất là phép quay 
RPY. 


Hãy tưởng tượng, gắn 
hệ toạ độ xyz lên thân một 
con tầu. Dọc theo thân tầu là 
trục z (hình 3.9): 

Rol là chuyển động 
lắc của thân tàu, tương 
đương với việc quay thân tàu 
một gốc ở quanh trục Z. 


Thân tàu 


x 


Pitch Ô 


Hình 3.9. Phép quay Roll - Pitch - YVau 


Pitch là sự bồng bẻnh, tương đương với góc quay Ô quanh trục y. 


Yaw là sự lệch hướng, tương đương với phép quay một góc `E 


quanh trục X. 


Xác định thứ tự quay: quay một góc \f quanh trục x, tiếp theo là 
quay một gốc Ô quanh trục y va sau đó là quay một góc ¿ quanh trục z. 


Theo thứ tự quay đó có thể biểu điễn phép quay RPY như sau: 


RPY (0,9, W)= R Œ,$). R(y, 6). R(x, #2) 


$ 
Š 
với: RŒ.9)=| o 
0 
C 
R@,Ð)=[_ 


(3.51) 
0 


7? 


L0 0 
Nước 0 C„ —§, 0Ô 
0 §S, CC, 0 
0 0 0 1 


Thay vào (3.5L) ta có: 


CC CgSs5y TS,CU„ C¿S;C, +5¡5y 


S%C©. S,5a5, +©C, SSC, €5 
RPV(@, Ô, t2) = 9 h0 ¿nụ $°ˆ0 $`* (3.52) 
—S CS, CạC, 0Ì" 
0 0 0 | 


3.4. CÁC BÀI TOÁN BIẾN ĐỔI NGƯỢC. 
3.4.1. Xác định góc quay và trục quay. 


Trên đây chúng ta đã nghiên cứu các bài toán thưận, nghĩa là chỉ 
định trục quay r và góc quay @ trước rồi tìm kết quả biến đối theo các 
phép quay đã chi định đó. 

Bây giờ, ngược lại với bài toán trên, giá sử đã biết sau phép biến 
đổi nào đó kết quả là vật thể đang ở trạng thái cuối hoàn toàn xác đình, 
vấn đề là phải tìm ngược lại xem các thông số biến đổi đó là gì, cụ thể là 
tìm trục quay k và góc quay Ô khi biển đối. 

Thông thường trạng thái cuối cúa vật thể cớ thể mô tả bằng ma 
trận Tp, gọi là ma trận trạng thái cuối, Giả sử ma trận T; được xác định 
ñÑƯ sau: 


1y W, Yy P‹: 
——.. 
: H_ Đề W_ D. Do, 


L0 0 0 1 


Như đã phân tích ở mục 3.1.4, mỗi cột của ma trận quay 3x3 
trong T; là một véctơ đơn vị chỉ phương một trục của hệ toa độ động 
UVVW, biểu diễn trong hệ toạ độ cố định XYZ. Hệ toạ độ động UVW gắn 
liền với vật thể đang xét. 
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Mặt khác do các phép biến đổi quay góc ÔØ nào đó quanh một trục 
k với ma trận quay (3.48) đã đưa vật thể đến trạng thái cuối. được mò ta 
bằna (3.53). Như vậy. ta có: 


UV W_ Py 
Đ< UỤ Ai, óc Thi 
uU, V_ W, P, 
0 0 01 
rV +C,  rV T—rŠ, nưV +TS, : (3.54) 
“sẽ... rẻV,+C, 1f,VạTr,S,„ 0 
` TỶ Xu SEN IE Vo ti n rV +C,  Ô 
0 0 0 I 


So sánh các phần tử tương đương của 2 ma trận (3.54), có thể xác định 
được các quan hệ cần thiết. Trước hết đễ dàng nhận ra p, =pø,=p =0, và 
ở đây ứng với trường hợp gốc của hệ toạ độ UVW không rời khỏi gốc của 
hệ toa độ XY 2, 


Cộng đường chéo cửa 2 ma trận (3.34) ở hai vế ta có: 

u+vy+wW,+ [=r Vụ + Ca + pˆV¿ + Cý +rÈV¿ + Cụ + l 
=(1-Cạ)(/ + vã +r)+3C¿+ ] 
=2(1+CŒ,) 


| 
Vậy: by = c0S@= 5 dc #9 1P WU, —[) - 3.55) 


Tính hiệu các phân tử tương đương của 2 ma trận, chẳng hạn: 


V—W, = 215, 
MÀ M. = 2t SŠ, (3.56) 
uUy~V, = 2r5„ 


Bình phương 2 vế của các phương trình trên rồi cộng lại ta có: 


(.T—w,)° +)” +, =v,)) =4S2 
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Vậy: 


: | P 
S„ =SIn@= +2 V0; —w,)  +(W, _—w.} +TÍH, —yv.} (3.57) 


Từ (3.55) và (43.57) với 0 < @ < I80” ta có: 
VW, —W,) +(w —=u,)+(u,~v,}Ÿ 


k2 0 U,+Vy+W, ¬ tông) 
Từ (3.56) xác định trục quay F: 
V„ —Wy W„—U, Ủy —V, 
lo 2sino ÂM 2sino se. 2sino GhếU 


Theo các công thức này thì khi ọ =0” hoặc 180” sẽ không xác định 
được trục quay F, nên tìm cách tính khác. 


Xét phần tử tương đương của 2 ma trận (3.53) và (3.54): 


D.22in0VE KT 
XẠ C2 
“x6 
Ww,= rVWu+ Cụ 
Từ đây suy ra; 


t.=# mm. SH: SV I 
\ Vụ l-cosø 


tt vn Si QaẺ Ív, —cose 
: V, Ý 1t-co 


L 


w,-C = 
TT in W„T—COS0 
bế l—cos@ 


Vì trong khoảng 0°< œ < 180” thì sin @ luôn luôn đương và theo 
(3.56) có thể thấy r„, r„ ï, luôn luôn cùng dấu với vế trái, nên có thể viết: 


Hàm Sgn(z) dùng để biểu điễn quan hệ “cùng dấu với x". 


L0) 


uU, —cOS 
r. =Šgn(V.~Wy) hư 
l—cosœ 
Vy—COSO 
r„ =5gn(W, —Uu,)0|— › (3.60) 
l1-cosœ 
r, =Sgn(u,—V,) Ti. | 
Ï— cosœ@ 


Có thể xác định các thành phần của trục quay r theo cách dùng 
phương pháp cộng các cặp còn lại của các phần tử đối xứng qua đường 
chéo các ma trận (3.54): 

uy +V, =2rr,V. =2rr(1— cos0) 
Vy -+Wy, =2rr,Vụ = 2r,r,(1— cos) (3.61) 
w,„+tu,=2rr,VÀ =2r,r (1- cos@) 


Thuận tiện hơn nếu chọn từ (3.60) thành phần có trị lớn nhất, ví 
dụ r„, rồi tính các thành phần còn lại theo (3.61): 


_ Uy V:, 

s“=——— 
2r (I-cos0) 

: w„+u, 

1, 


ˆ 2r.,(—cos0) 
Ví dụ: Cho Rứ, @) = R(y, 90). RŒ, 90”). Hãy xác định trục quay 


r và góc quay œ đề: 


© CC 


RŒr,0)= 


œẽẻ¬ CC C 


| 
0 
0 
0 


©c CC CC 


Giai: Từ (3.55): 


] Ị ] 
COs@ =—(u,+v .+w,-l)=—(0+0+0-])=-—— 
Ạ 2t x#Vv 1W 1) 2\ ) 2 
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Từ (3.57): 


| : : : 
sino= sW(V,~Wy)” +(W, —ú,} +(0y—VV) = 
p=sƒ v)) +ẮMW, | 


l 5 P 
=Ẻ NI(T- 0) +(t-0)7 +(i-0) oi 
2 2 
Theo (3.60): 
`=“ 
Vậy: 
ANH 
Hình 3.10. 


Tim trục qua) r 
uà góc qugU @ 


3.4.2, Xác định 3 góc Euler 


Trong phần 3.3.5 đã biểu thị sự quay của một vật thể thông qua các 
góc ¿, Ô và . Ở đây là bài toán ngược lại, khi đã biết trạng thái cuối của 
vát thể là kết quả của phép quay đó, vấn đẻ là từ đó xác định lại các góc 
quay này. 

Cũng như phần trên có thể mỏ tả trạng thái cuối của vật thể bằng 
ma trận T (3.53) và như vậy ta có: 


R(j,9,V)=R(z,0). R(y.Ø). R(z.)= T, (3.62) 
Trong đó R(¿, 6, ) xác định bằng công thức (3.50). 


Lần lượt cho cân bằng các phần tử tương ứng của 2 ma trận trong 
phương trình (3.62) ta có các biểu thức sau: 
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u, =€C¿CọC, S5 
u, =C,CạC,, + C5 
U, = —SuÉœw 
sa... 6 
vị =—S,Ca5„ + C5 


VỤ 


bà SaSu 
Ww,= CS, 
Wy =SuŠn 
w„=Œ, 


Từ hệ các phương trình này xác định ¿, 6, XỨ như sau: 
Từ (3.71) ta có : 
| 


Ô=arccosw, =cos” W, 
Từ (3.69) tạ có: 


ø=eosÍ Má 
sing 


X 


Từ (3.65) và (3.72) ta có: 


Ự“= cos [- zẽ 
sịn g 


(3.63) 
(3.64) 
(3.65) 
(3.66) 
(3.67) 
(3.68) 
(3.69) 
(3.70) 
(3.71) 


3.72) 


(3.73) 


(3.74) 


Các lời giải từ (3.72) đến (3.74) chưa dùng được. bởi vì tính đa trị 


của hàm lượng giác arccos và bởi vì có hàm số sin 8 ở mâu số, cho nẻn sẽ 
không xác định khi Ð = 0” hoặc Ô = 75 + 180”. 


Người ta thường dùng hàm arctg2(y.x), gọi là hàm arctg2 biến 


hoặc văn tất hơn là hàm arctg2. với mục đích xác định được góc thực duy 
nhất với đấu của tý thức y/x. Hàm số trả về giá trị góc trong khoảng -7t < 
Ð < rbằng cách xét đấu của y và x (hình 3.11) s 
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Ví dụ: 
arctg2 (-l/-I) = -13%" V 
còn arctg2 (1/1) = 45” 


Trong một số 
ngòn ngữ lập trình hiện vi 


đại hàm arctg2 đã có Ấ 6 X 
sản trong thư viện. ——==== 


Bởi vậy cần thực 
hiện thủ thuật toán học X-V- 


~X-Y+ ‡ X+Y+ 


“củ X+Y- 
sau: nhân 2 vế của 
phương trình (3.62) với : 
ma trận nghịch đảo Hình 3.11. Hỏm arctg2 (v,x) 
RŒ.$)” ta có: 
R ,6)` Ty = R (y.9). R (2) (3.75) 


Vế trái của phương trình (3.75) là một hàm của các phần tử ma 
trận Tp và góc quay ó. Thực hiện phép nhân ma trận ở vế phải của (3.75), 
tìm ra các phần tử của ma trận có giá trị bằng 0 hoặc bằng hằng số, cho 
các phần tử này cân bằng với những phần tử tương ứng của rna trận ở vế 
trái. Cụ thể từ (3.75) ta có: 


C5, 0 0[|u v, W, Pp, 

3, C¿ 0 0[ [Uy Vý Wyj pQỊ. 

0 0 I O0[|u, v, W, Pp, Ñ 

0 0 0 1110 0 1 

CGu. =Ca9%y, suy Ô (3.76) 
N== €0 0 

-SCy/ 5gŠ, Cy Ô 

0 0 0 1 


Nhân 2 ma trận ở vế trái của phương trình (3.76) và chú ý rằng p.. 
py. p, bằng 0 vì phép biến đổi Euler chỉ toàn phép quay, không chứa một 
phép tịnh tiến nào, ta có ma trận sau: 
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Cu, 5H, CF ÖyŠy Cyw,+9ywy 0 

Xử Ta m7. ãẽ ố. n6 ca... 
1. v_ M_ 0 (3.77) 
0 0 0 | 


Cần bằng ma trận (3.77) và ma trận ở vế phải của (3.76), cho 2 
phần tử ở hàng 2 cột 3 bằng nhau, ta có: 


-Saw, + Cạw, = Ô (3.78) 
từ đó: 
số siná M, 
tgộ == = = 
Có cosố w, 


vậy póc ó có thể xác định bằng hàm arctg2 biến: 
Ò = arcfg 2 (W,, W,) 
_snd_ —W, 
Từ (3.78) ta cũng nhận được: !gộ = = 
COSỐ —W 


vậy trong trường hợp này:  @= arctg 2 (-W,,-wW,) 


Như vậy phương trình (3.78) có một cặp nghiệm cách nhau 1807, 
khi lập trình máy tính thường viết: @= $ + 180” 


Nếu cả w và w„ đếu bằng Ó thì góc ¿ không xác định được. đó là 
trương hợp suy biến và ta lấy ÿ = 0. 


Tiếp tục so sánh các phần tử của 2 ma trận nói trên ta có: 


CụW, + SỤW, = 5ù 


Từ đó: Ø =arcig2(C,w, +ố,w,,w.) 
Tiếp theo ta có: 

- S¿U, + Cụ Uy, = Sự 

- ,V, + Cụ VỊ, = Cự 


Vậy: 
§5 


W =arctg 2 (- Sạu, + Cạ uy - S¿v, + Cạ vị) 


Tóm lại 3 góc Euler, lời giải bài toán ngược, được xác định bảng 
các công thức sau: 


ÿ = arctg 2 (ay, a,) F (3.79) 
Ø =arctg 2 (CyW, + SạW,, W„) (3.80) 
*P = arctg 2 (-S¿u, + Cạu,, - SạV, + Cạ VỊ) (3.81) 


3.4.3. Xác định 3 nóc RPY 


Phép biến đổi Roll - Pitch - Yaw (RPY) đã được mô tả ở phần 
3.3.6. Kết quả của phép biến đổi đó là vật thể đạt tới trạng thái cuối, mô 
tả bằng ma trận Tị, (3.53) và như vậy ta có; 

RPY (0,62Đ) = R (z, ó). R (y, 0). R (2) <T, (3.82) 


Cách giải bài toán ngược này. để tìm các nghiệm ÿ,8, từ phương 
trình (3.82), được tiến hành tương tự như khi thục hiện lời giải cho phép 
quay Euler ở phần trên. 

Nhân hai vế của (3.82) với ma trận nghịch đảo R(z. $)ˆ, ta có: 

R(z,0)'T,=R (y,0).R(x. 3) (3.83) 


Sau các phép nhân ma trận, ta có: 


LŨ `. ` `. `... 
—5¿U, tu, —S/V Cv, ŠyW, +TCw, Ô 


u, v W, ' ï | 


0 Ũ 0 | 


(3.84) 
Cj Cụ, SẠC, 0 
0Œ -§, 0 
: —% Cấu Cục, 0 
0 0 0 | 


Cân bằng 2 phần tử ở hàng 2 cột l. ta có: 
-3;Uu, + Cá U, =ÔÖ 
Phương trình này cho 2 nghiệm, như đã biết: 
$ = arctg 2 (u,, u,) 
và $= +I80! 
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Tiếp tục cân bằng các phần tử tương ứng của 2 ma trận trong 
phương trình (3.84), ta có: 


-.=U, 
C,= Cạu, + S¿U, 
do Vậy: 
Ø =arctg 2 (-u„, Cạu, + §¿u,) 
Ngoài ra, ta có: 
- Sự =- Sạ W, + Cá W, 
Cụ = - Sạ VỤ + Ca VỤ 
do Vậy: 


tự = arctg 2 (Sạ W,- Cá W, { Sự Và + Cụ v.) 


Như vậy ta đã xác định được các góc Roll, Pítch và Yaw theo các 
phần tử của ma trận Tị, bằng các công thức sau: 


$ = arcfg 2 (u„, u,) (3.85) 
Ø = arcig 2 (-u,, Cạu, + S¿u,) (3.86) 
tự =arctg 2 (S¿W, - CạW,, Ÿ SạV, + CV, ) (3.87) 
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CHƯƠNG JV 


HỆ PHƯƠNG TRÌNH ĐỘNG HỌC ROBOT 


4.1. ĐẶT VẤN ĐỀ. 


Cơ cấu chấp hành của robot thường là một cơ cấu hở, gồm một 
chuỗi các khâu (lmks) nối với nhau bằng các khớp (Joints). Các khớp 
động này là khớp quay (R) hoặc khớp tịnh tiến (T). Để robot có thể thao 
tác linh hoạt, cơ cấu chấp hành của nó phải cấu tạo sao cho điểm mút của 
khâu cuối cùng đảm bảo dễ đàng di chuyển theo một qui đạo nào đó. 
đồng thời khâu này có một định hướng nhất định theo yêu cầu. Khâu cuối 
cùng thường là bàn kẹp (gripper) hoặc là khâu gân liền với dụng cụ làm 
việc (tools). Điểm mút của khâu cuối cùng là điềm đáng quan tâm nhất vì 
đó là điểm tác động của robot lên đối tác và được gọi là "điêm tác động 
cuối" (end - effector). Chính ở điểm này cần quan tâm không những vị trí 
nó chiếm trong không gian. mà cả hướng tác động của khâu cuối đó. 


Gắn vào "điểm tác động cuối” này một hệ toạ độ động thứ n và 
gắn với mỗi khâu động một hệ toạ độ động khác, còn gắn liền giá đỡ với 
hệ tọa độ cố định. Đánh số ký hiệu các hệ này từ o đến n bất đầu từ giá cố 
định. Khi khảo sát chuyển động của robot cần biết "định vị và định 
hướng” tại điểm tác động cuối trong mọi thời điểm. Nhiều khi lại cần biết 
cả vận tốc và gia tốc chuyển động của robo( tại điểm tác động cuối đó 
cũng như tại các điểm khác trên robot. Đó là nội dung quan trọng của bài 
toán về động học robot. Các lời giải của bài toán này được xác định từ 
những phương trình động học của robot. Các phương trình này là mô hình 
động học của robot. Chúng được xây dựng trên cơ sở thiết lập các mối 
quan hệ giữa các hệ toạ độ động nói trên so với hệ toa độ cố định. 

42. XÁC ĐỊNH TRANG THÁI CỦA ROBOT TẠI 
" ĐIỂM TÁC ĐỘNG CUỐI" 

Như trên đã nhấn mạnh tại các " điểm tác động cuối” của robot 
không những cần biết vị trí của điểm mút của khâu cuối cùng, tức là điểm 
tác động của robot lên đối tác, mà còn phải xác định hướng tác động của 
khâu cuối cùng đó. 

Như vậy trạng thái của robot tại " điểm tác động cuối” hoàn toàn 
xác định bằng sự định vị và định hướng tại điểm tác động cuối đó. 
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Như đã đề cập ở phần 3.1.4, biểu thị sự định vị và định hướng đó 
bằng, ma trận trạng thái cuối Ty. Ma trận này được viết lại như sau: 


ủ x l Ww, P BỊ 

`. -.¬... 

— |H W WM P 4-0 
§ ð 4# 4) 


Trong đó các phần tư của ma trận 3xI là toa độ p,. P, p, cua ` 
điêm tác động cuối” (E); Mỗi cột của ma trận quay 3x3 là một véctơ đơn 
vị chỉ phương một trục của hệ toa độ động ƯVW biểu điển trong toạ độ 
cố định XYZ. 


Hệ toa độ động UVW gắn liên với khâu cuối cùng và có gốc là " 
điểm tác động cuối", Nếu theo ký hiệu các hệ toạ độ được xác định đánh 
số từ o đến n thì thay thế UVW bằng x,„ y, z„ tương ứng. 

Trong nhiều tài liệu kỹ thuật của nước ngoài dùng cả ký hiệu hệ 
toa độ này là n, s, a. Các ký hiệu hệ toa độ này là hoàn toàn tương ứng 
với nhau và được dùng tuỳ nơi để thích hợp với tính hệ thống khi diễn đạt 
ở nơi đó: 

U,V.W~X,.ÿ,.7,~D,sS, 4 

Trên hình 4.L biểu thị các hệ toa độ này. so với hệ toa độ cố định 

Xu Yo 


*% % 


Hình 4.1. Hệ toạ độ gắn liền với bàn kẹp 
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Hệ toa độ gắn liền với bàn kẹp của robot có các véctơ đơn vị chỉ 
phương các trục như sau: 
a - Vectơ có hướng tiếp cận (approach) với đối tác. 


s - vectơ có hướng đường trượt (sliding) đóng mở bàn kẹp. Có tài 
liệu còn gọi là phương nấm bắt (occupation) và ký hiệu là o. 


n - vectơ pháp tuyến (normal). 
n=sxa (4.2) 
và như vậy s=axn (4.3) 


Thay ký hiệu hệ toa độ UVW bằng n, s, a có thể viết lại ma trận 
trạng thái cuối Tị (4.L) như sau: 


1. $y qy Đ. 
m.~ ` .a... 
#lhệt, .. cân, +0) 
0 0 01 
Việc định hướng khâu nụ 
cuối có thể thực hiện theo 
phép quay Roll - Pitch - Yaw 
hay một số phép quay khác. Roll.¿ 


Hình 4.2 biểu thị các góc quay 
Roll - Pitch - Yaw của bàn kẹp 
robot. 


Piích,Ð 


Ÿn 


Bàn kẹp của robot có Yaw,W 
thể tác động trực tiếp với đối 
tượng ví dụ cầm, nắm và di 
chuyển chúng. Nhiều khi các 
dụng cụ thao tác lại được kẹp 
chặt trong bàn kẹp hoặc sắn : 
trực tiếp với cánh tay của Hình 4.2. 
robot, Lúc đó” điểm tC động Các góc quay Roll- Pitch - Yau 
cuối" được hiểu là điểm đầu của bàn kẹp robot 
mmít của dụng cụ. Trên hình 
4.3 mô tả hệ toa độ x„ Vạ Zz„ gắn liên với điểm đầu mút của dụng cụ, 
trong đó trục z„ nằm đọc theo phương của dụng cụ. 
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Hình 4.3. 
Hệ tọa đô gắn liền uới dụng cụ. 


4.3. MÔ HÌNH ĐỘNG HỌC 
4.3.1. Ma trận quan hệ 


Chọn hệ toa độ cố định gắn liền với giá đỡ và các hệ toa độ động 
gắn với từng khâu động. Ký hiệu các hệ toạ độ này từ 0 đến n, kể từ giá 
cố định trở đi. 

Một điểm bất kỳ nào đó trong không gian được xác định trong hệ 
toa độ thứ ¡ bằng bán kính véctơ rị và trong hệ toa độ cố định Xụ, Vạ; Zu 
được xác định bằng bản kính véctơ rụ: 


Fạ= AI,À;... AT; (4.5) 
hoặc Tạ =Ïl\P; (4.6) 
với T=A,À;...A,,t=l....n (4.7) 


Trong đó ma trận A, mô ta vị trí và hướng của khảu đầu tiên: ma 
trận Á; mô tả vị trí và hướng của khâu thứ 2 so với khâu đầu: ma trận À, 
mô tả vị trí và hướng của khâu thứ ¡ so với khâu thứ ¡ - 1. 

Như vậy. tích của các ma trận A, là ma trận T; mô tả vị trí và 
hướng của khâu thứ ¡ so với giá cố định. Thường ký hiệu ma trận T với 2 


9] 


chỉ số: trên và dưới. Chỉ số đưới để chỉ khâu đang xét còn chỉ số trên để 
chỉ toa độ được dùng để đối chiếu. Ví dụ, biếu thức (4.7) có thể viết lại là: 

T="T,=A',T, (4.8) 
với TT.= A;A:... Á, (4.9) 
là ma trận mô tá vị trí và hướng của khâu thứ ¡ so với khâu thứ nhất. 
Trong ký hiệu thường bó quá chí số trên nếu chỉ số đó băng 0. 

Đenavit J.& Hartenberp R.S. [5] đã đẻ xuất dùng ma trận thuân 
nhát 4x4 để mò tà quan hệ giữa 2 khâu liên tiếp trong cơ câu không gian. 
Pieper D.L, [L2] đã đầu tiên áp dụng ma trận thuần nhất 4x4 trong nghiên 
cứu robot. Litvin F,L.]54] đã dùng ma trận thuần nhất 4x4 trong nghiên 
cứu lý thuyết ăn khớp bánh răng. 

4.3.2. Bộ thông số DH 


Dưới đây trình bày cách xây dựng các hệ toa độ đối với 2 khâu 
động liên tiếp ¡ và i+l. Hình 4.4 là trường hợp 2 khớp động liên tiếp là 
khớp quay. Hình 4.5 khớp ¡ là khớp tịnh tiến. 


Hình 4.4. Các hệ toa độ. đối với 2 khâu động liên tiếp 
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Hình 4.5. Cóc hệ toạ độ đối uới 2 khâu động liên tiếp có khớp tịnh tiến 


Trước hết xác định bộ thông số cơ bản giữa 2 trục quay của khớp 
động 1 +] Và 1: 


a, là độ dài đường vuông góc chung plữa 2 trục khớp động ¡ +[ và 
1. 


ơ, là góc chéo giữa 2 trục khớp động ¡ +1 và ¡. 


d, là khoảng cách đo dọc trục khớp động ¡ từ đường vuông góc 
chung giữa trục khớp động 1 +l và trục khớp động ¡ tới đường vuông góc 
chung giữa khớp động ! và trục khớp động ¡-l. 


6, là góc giữa hai đường vuông góc chung nói trên. 


Bộ thông số này được gọi là bộ thông số Denavit - Hartenberg, 
hoặc viết tất là bộ thông xố DH. 


Biến khớp (joint variable): 
Nếu khớp động ¡ là khớp quay thì Ø, là biến khớp. 
Nếu khớp động ¡ là tịnh tiến thì d, là biến khớp.. 


Để ký hiệu biến khớp dùng thêm dấu * và trong trường hợp khớp 
tịnh tiến thì a, được xem là bằng 0. 


4.3.3. Thiết lập hệ toạ độ. 


Gốc của hệ toạ độ gắn liền với khâu thứ ¡ (gọi là hệ toa độ thứ ï) 
đặt tại giao điểm giữa đường vuông góc chung (a,) và trục khớp động ¡+]. 
Trường hợp 2 trục giao nhau thì gốc hệ toa độ lấy trùng với giao điểm đó. 
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Nếu 2 trục song song với nhau thì chọn gốc hệ toạ độ là điểm bất kỳ trên 
trục khớp động I+Ï. 

Trục z, của hệ toạ độ thứ ¡ nằm dọc theo trục khớp động ¡+]. 

Trục x, của hệ toa độ thứ ¡ nằm đọc theo đường vuông góc chung 
hướng từ khớp động ! đến khớp động 1+l. Trường hợp 2 trục giao nhau, 
hướng trục x, trùng với hướng vếctơ tích z4 x 2, tức là vuông góc với mật 
phẳng chứa 7¡sz. 


Ví dị Ú: Xét một tay máy có 2 khâu phẳng như hình 4.6 


Hình 4.6. Tay máu có 2 khâu phẳng ( 0 trí bết kỳ) 
Gán các hệ toa độ với các khâu như trên hình 4.6: 
Trục Za,2z, và z; vuông góc với mặt tờ giấy. 
Hệ toa độ cố định là o,X„y„z¿ chiều x¿ hướng từ o, đến oi. 
Hệ toa độ 0,X,Yy,z, có gốc o, đặt tại tâm trục khớp động 2. 


Hệ toạ độ o;X;y;2¿ có gốc o; đật tại tâm trục khớp động cuối 
khâu 2. 


Bảng thông số DH của tay máy này như sau: 


Kháu | 6, _ứy, 8, d 
1 6), H) đụ lô) 
2 8`. L lô) a¬ Ð) 


Ví dụ 2: Robot SCARA có 4 khâu như hình 4.7. Đây là robot có 
cấu hình kiểu RRTR.(toàn khớp quay R). Bàn kẹp cố chuyển động xoay 
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xung quanh :.ục thẳng đứng. Các hệ toa độ gắn lên các khâu như 
hình 4.7. 


8; 


Ó: La 
Xụ 0, 
Z:. Z¡ 


Hình 4.2. Robot SCARA uà các hệ toạ độ 


Đối với tay máy này, các trục khớp động đều song song với nhau. 
Bộ thông số DH của robot SCARA lập thành bảng sau: 


Khâu 8, œ II D, 
L | 0), | 0 đi 0 
, Bb. 80" â; 0 
3 0 ) D: 
4 SA "Í.. 0 D | 


4.3.4. Mô hình biến đổi. 


Trên cơ sở đã xây đựng các hệ toạ độ với 2 khâu động liên tiếp 
như trên đã trình bày, có thể thiết lập mối quan hệ giữa 2 hệ toa độ liên 
tiếp theo 4 bước sau đây: 


1. Quay quanh trục z;, một góc Õ,. 
2. Tịnh tiến dọc trục z,., một quãng d,. 
3. Tịnh tiến đọc trục x,¡ (đã trùng với x,) một đoạn a,. 


4. Quay quanh trục x, một góc œ,. 
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Bốn bước biến đổi này được biểu hiện bằng tích các ma trận thuán 
nhất sau: 

A, =RŒ.9,).T.(o,o,đ,).T,(a,,o,o).RX,0,) (410) 

Biểu thức (4.10) là quan hệ giữa hệ toạ độ ¡ so với hệ toa độ ¡-1 và 
được gọi là mó hình DH (DH - model). Cách thiết lập mô hình động học 
theo kiểu mô hình DH tỏ ra thuận tiện trong khi giải quyết các vấn để cơ 
học robot, vì thế được dùng khá rộng rãi. Ngoài ra còn tồn tại một vài 


cách khác đế thiết lập mô hình động học như Univetsal - model, S- model 
[26]. 


Các ma trận ở vế phải phương trình (4.10) tính theo các công thức 
(3.41). (3.37) và (3.39). Sau khi thực hiện phép nhân các ma trận nói trên, 
tả có: 


GÌ. Ôn. so 

— Sạ CaC„  —CaŠ„ đu5a 

0 5 CÀ CỬ vế, (4.11) 
0 0 0 Ị 

Đối với khớp tịnh tiến (a = 0) thì ma trận A, có đạng: 


Cự = aiCại ` Øi ` di 0 


3: S4 CC " C ` 0 
h0 8, C, — d, (4.12) 
Ô 0 0 ] 


Đối với khớp quay thì biến khớp là 6,„ còn đối với khớp tịnh thì 
biến khớp là d,. 

4.3.5. Phương trình động học. 

Ma trận T, là tích các ma trận A, (xem 4.7) và là ma trận mô tả vị 
trí và hướng của hệ toa độ gắn liền với khâu thứ ¡, so với hệ toạ độ cố 
định. Trong trường hợp ¡ = n, với n là số hiệu chỉ hệ toạ độ gắn liền với " 
điểm tác động cuối" (E) thì từ (4.7) ta có: 

T,= A/A; ă A, (4.13) 

Mặt khác, hệ toa độ tại " điểm tác động cuối" này được mô tả 
bằng ma trận Tp (xem (4.4)). Vì vậy hiển nhiên là: 


9% 


(4.14) 


Hoặc: 


l§ ấy -Øy Ái 
Hy $#ụ 8 
X> TỰ nh duợ) lE' lên (4.15) 
| Hy ; dq;y Dz 
l0 0 0 1 ị 


Phương trình (4.15) là phương trình động học cơ bản của robot. 


4.4. TRÌNH TỰ THIẾT LẬP HỆ PHƯƠNG TRÌNH ĐỘNG 
HỌC CỦA ROBOT. 


Để thiết lập phương trình động học của robot, có thể tiến hành 
theo các bước sau: 


Ï. Xúc định các hệ toạ đó 


Việc găn hệ toạ độ với các khâu có vai trồ rất quan trọng khi thiết 
lập hệ phương trình động học của robot. Nguyên tắc chung đã trình bày 
một cách tổng quát trong phần 4.3. Trong thực tế các trục nối khớp động 
của robot thường song song hoặc vuông góc với nhau, tức là rơi vào 
những trường hợp đặc biệt, nên có thẻ BÂY nhầm lần. Hơn nữa việc xác 
định các hệ toạ độ cần phải phù hợp với các phép biến đổi của ma trận A, 
để có thể sử dựng được bộ thông số DH. Vì thế, trình tự xác định các hệ 
toa độ cần được lưu ý các điểm sau: 


- Trục 7z, phải chọn cùng phương với trục khớp động 1+! 

- Các hệ toạ độ phải tuân theo qui tắc bàn tay phải, như đã nêu 
trong phần 3.l. 

- Khi gắn hệ toạ độ lên các khâu, phái tuân theo các phép biến đối 
cửa ma trận A, (xem 4.10). Đó là 4 phép biến đổi : 


R(,8,),Tp(0,ø,d;).Tp(a;,o,o), R(x,ø,) 


Như vậy có thể xem hệ toạ độ thứ ¡ + 1 là do phép biến đổi từ hệ 
toạ độ thứ ¡. Các phép quay (R) và iịnh tiến (T,) trong các phép biến đối 
này phải có mặt trong các phép biến đổi cúa ma trận A, (4.10). Các thông 
số DH cũng được xác định dựa vào các phép biến đổi này. 


Ví dụ, nếu việc gắn một hệ toa độ nào đó mà gốc o, đã tịnh tiến 
dọc theo trục y,¡ một đoạn thì việc làm đó không đúng vì không có phép 
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biến đổi TT, (o,y,o) trong ma trận A,. Tương tự cũng không có phép quay 
quanh trục v trong ma trận Á.. 


Việc gắn hệ toạ độ lên các khâu ở vị trí, Khi mà các biến khớp có 
giá trị ban đầu, thường bằng 0. 

2. Lập bảng thóng số DH. 

Ÿ. Xác định các ma trận A, theo các thông số DH. 

ý. Tính các ma trận Ẳ.. 

3. Lập phương trình động học cơ bản. 

San đây trình bày chỉ tết các bước khi thiết lập hệ phương trình 
động học của robot; 

Ví dụ: Cho một robot có 3 khâu với cấu hình RRT như hình 4.8. 
Hãy thiết lập hệ phương trình động học của robot này. 

Giải. 

1. Xác định các hệ toa độ 

Đạt các trục toạ độ Z, (¡ =0.1,2,3) cùng phương với các trục khớp 
động, như trên hình 4.9. 

Trục z,xem như là đã quay đi một góc 90 so với trục Z„. Bước 
quay này tương ứng với phép quay R(x„œ,) trong biểu thức tính ma trận 
A„ Muốn vậy, trục x„ phải vuông góc với z„ và z¡. Chọn chiều của x, từ 
trái sang phải để góc quay œ, = +90” ( chiều quay dương là chiều quay 
ngược chiều kim đồng hồ). 


% 


—— 


ĐỒ (i02 1à Ho) Huệ! Hình 4.9. Đặi các hệ toạ độ theo 


phương án Ï 
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Gốc o, đã chọn xem như là đã tĩnh tiến dọc trục z„ một đoạn d, so 
với gốc O„ và tương ứng với phép biến đối T, (o,o,d,). 


Các trục y„ Và y, xác định theo qui tắc bàn tay phải. 


Nếu chọn trục Z2 như hình 4.9. tức là xem như là đã quay trục z, đi 
một góc 90” quanh trục y, thì phép hiến đổi này không có trong biểu thức 
tính A,, nên không dùng được và cần thay đổi vị trí của khâu thứ 3 như 
trên hình 4.10, tức là thay đối vị trí ban đầu của robot để làm mòc tính 
toán. 


Theo hình 4.10, trục z; có phương thâng đứng, ở vị trí này xem 
như trục z¡ đã quay quanh trục x, một góc œ„= - 90° để thành z;. Nhưng 
nếu vấn đất gốc toạ độ 0; tại vị trí cũ như phương ấn I trên bình 4.0 thì 
Kem như là đã tình tiến gốc toa độ o, đi một đoạn đọc trục y¡, tức là thực 
hiện phép tình tiến T.( o,y,o). Tuy nhiên phép tịnh tiến này không có mặt 
trong biểu thức tính A, Do vậy phải chọn gốc toạ độ o; trùng với gốc toa 
độ o,, tức là để độ tịnh tiến dọc theo trục y bằng 0. 


Hình 4.10. Hệ toạ độ gắn liền lên các khâu 
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Đặt gốc o, tại tâm bàn kẹp và chọn trục z¿, x; như trên hình 4.10. 
Như vậy là đã tịnh tiến gốc toạ độ đọc theo trục z¿ một đoạn d:, tương ứng 
với phép biến đổi T,( o,o,d.). ở đây đ, là biến khớp. 


2. Láp bảng thông số DH nụt san: 


^r 1 

| Khâu L 0 HN ầ, đ, 
] 6`, ID 90 0 đề 

2 ] 6, - 90 0 0 Ï 

+ — l 

3 | 0 l) L Q_- d) | 


3. Xác định các ma trận A, theo (4.11) với các thông số DH từ 
bảng Irên, ta có: 


cm (Ổˆ lểnu CƠ) 
Áj= Sạ Ũ — Cụ 0 
0 1 0 3 
B0 (0 1] 
œ;y 0 —Ñn; 0Ì 
A,= 5s; 0C, 0 | 
0 -I 0 0| 
00 0 ] 
I0 0 
0 1 0 
A4.= 
: 0 0 1 a, 
0 0 0 1 


1. Tính các ma trận T, 
Ma trận ”T: = A; 
Ma trân !T: = A.. Tạ 


_ Ta 


G; 0 —Š; 010009 vo 0 —% S4 | 

= S% 0 €; 0J0100 b % 0 G; €;d, 

` |0 -I 0 0001đ| |0 -1l 0 0 
0 0 0 110001 0 0 0 | 


Ma trận T:= Á,. TT: 


Cụ 0 Sội 0 Cá; Úc Sa; Sạ;d 
T« Si 0 Cạc 0 l| So; 0 Cạ; Cạ,d; 
: 0 1 0 d0 -1l 0 0 
0 0 0 110 0 0 1L ị 


Cạ¡C?;› " Si = CauŠn; " CpSạađ, | 
SaiC¿ Cà, " SpI962 ă 5SaiSaa4) 
Sà) 0 Ca; Cạ;a, +á, 
0 0 0 1 
5$. Thiết lập phường trình động học 
Theo phương trình (4.15) ở đây n = 3, ta có: 
lẹ ` n. .. 


Phệt siêu: ‹ đụ: Ji |— „my 


“II. ... 1s ¿s‹ : 
L0 0 0 l 
Từ đó ta có hệ phương trình sau: 
n. = Cai Cọ; n, = Sa, Ca; n1, = So; 
Su = x¡ s, = Cọ, s,=Ô 
a, = - Cụ,Sg; ay = -ŠpS0 _8, = Cọạ 


p.=- Có. S;d; Py = -%¡ Sna P,= nạ đ; + đ, 
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4.5. MÔ HÌNH TOÁN ĐỒ CHUYỂN ĐỔI 


Từ (4.7) lập biểu thức T, đối với trường hợp n = 6. là trường hợp 
thường gặp: 


T,= ÁjA;Á¿A„A¿A, (4.16) 


T¿ là ma trận mô tả vị trí và hướng của khâu thứ 6 trong hệ tọa độ 
cơ sở gắn với giá đỡ, có ký hiệu là số Ö. 


Để mô tả Tụ trong hệ toa độ trung gian nào đó, ví dụ, hệ toạ độ thứ 
- K, thì ta dùng cách lập biểu thức tương tự như đã làm với (4.9): 


6 
HE HÌ : : (4.1) 


Hình 4.11. Eobot uà uất 


S thể đối tác 


Khi hoạt động robot còn phải có quan hệ với đối tác và các thiết 
bị chung quanh, vì vây cần mô tả T, trong hệ toa độ chưng nào đó. Ví dụ, 
hệ toa độ cơ sở gán liên với giá đỡ robot lại liên hệ với hệ toạ độ chung 
bởi phép biến đổi z (hình 4.11). Bàn kẹp của robot lại có gắn một công 
cụ, có quan hệ với vật thể đối tác bởi phép biến đổi E. Như vậy vị trí và 
hướng của công cụ tại điểm cuối được mô tả trong hệ toa độ chung bởi X: 

X=z42T,E (4.18) 

Quản hệ (4.18) có thể mô tả bảng mô hình toán đồ chuyến đổi 

-_ (transform graph) trên hình 4. 12. 
Từ toán đồ này có thể rút ra: 
T2 AE. (4.19) 


với Z' và E' là các ma trận nghịch đảo. 
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Hình 4.12. Mô hình toán đồ chuyến đối 


__ 46. HỆ PHƯƠNG TRÌNH ĐỘNG HỌC CỦA CÁC ROBOT 
ĐIÊN HÌNH 


4.6.1. Hệ phương trình động học của robot Stanford 


Robot Stanford có 6 khâu với cấu hình RRTRRR (khớp thứ 3 là 
khớp tịnh tiến T, còn lại là các khớp quay R). Kết câu cúa robot Stanford 
như hình 4.13. lẻ 


Hình 4.13. Robot Stanƒord 
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Trên hình 4.14 trình bày mô hình của robot Stanford với việc gắn 
các hệ toạ độ lên từng khâu. Để đơn giản trong khi viết các phương trình 
đóng học của robot, qui ước cách viết tất các hàm lượng giác như sau: 


C¡ =cos Ø,, Ci = cos Ô¿ 


S,=sinÐ,, Š; =sinÐ; 

€ụ= cos (9, +Ô2), S¿¿= sm (9, +Ð;) 
9= sin (Õ +8, +8) 

C;,,= cos (9, + Ô; +Ð,) 


Hệ 
toạ độ gần 
lên các 
khâu của 
robot như 
hình 4.14 
(kích thước 
của khâu 
chấp hành 
cuối có thể 
thay đổi khi 
găn các 
công cụ 
kbhác nhau 
nên chọn 
O, =Ô). 


Hình 4.14. Hệ toạ độ của Rohot Stanƒord 


Bảng thông số DH (Denavtt - Hartenberg) của robot Stanford như 


sau: 
Khâu —Ð 3 ¬ na Khớp 

N::: 9¿ ám -90) ö 0 R 

2 0. | 90 0 đ. R 
“.. 0 0 0 đ& II HN: 
HN DN -90" 0 0 R 
ị 5 Bể 90" lũ 0 TRE 
s5 Đc h ô ö R— 
_” : Các biên khớp _ 
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Các ma trận À của robot Stanford được xác định như sau: 


,: Ú: cÒÄj (Ổ lu đj +» vÍ 
Ñ 0Œ 0 S 0 -C, 0 
đi*E A4,= 5 
[I0 =1 0 0 0 1 0 2, 
l0 ö0 0 1| 0 0 0 1 
f1 0 0 0Ì Œ, 0 -&, 0| 
l0 10 0 % .9_.Œ€ 0 
DI Ä vẽ 
0 0 1 4, 0 -I1 0 0420) 
0 00 1 0 0 0 1 
Có 202 xi9 ny , "Ố Œ, =8, 0 0 
% 0 -Œ,/ 0 Ñ Ê. 50 Ú 
bi e N 
0 1 0 0 00 10 
0 0 0 1 00 01 


Tích của các ma trận A, đối với robot Stanford được bắt đầu ở 
khâu 6 và chuyển dần về gốc; theo thứ tự này ta có: 


C..=Š. \0 0 
: % Œ 00 
l.= 
0 0 1 0 (4.21) 
0 0 0 1 
CC =ŒS, § 0Ô 
4 »;G, —;Ð C, 0 
74 = Á,Á, = 
` C, 0 0 (4.22) 
0 0 0 ' 
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CC 5%, —CCáS,T—5,Cc Củ5; 0 

n. #Ä'= SVŒC, +CŠ%, — 5,9, tt CÓ S5, Ô 
" Ki, Số Œ 0|423 

¬- 0 0 1 


¬ 


CC =Šj%, —C¿CŠ, „C2 C5; Ô 
_| &GC+GS%, —SG%+CŒ S5, 0 


TP GA AVM|L sự ĐC %SÓ 4 |đ29 
Ö Ö 0 | 

C(CGG-S8)-S8G -GCGG+SG+S5% 

" _ÌS(GGG-SS)+C&G -S(GGQG+S8)-G§S 
xa... -§G5+Q§% 


0 0 


lót 8 LÝ Si SƯỚG... 
Ki NY -= Œ,C, = C,d: 


so: đ, (4.25) 
0 L ˆ| 
Cuối cùng: 
CÓ. s9 ‹$ 0 
SG 2% —C, ÔÖ 
= s4 36 : " TIM 
Š” s2 đỔi'⁄0 (4.26) 
0 0 0 1 


Để tính T, phải nhân A, với "T; sau đó cân bằng các phần tử của 
ma trận T, ở cả hai vế, được hệ thống các phương trình sau: 
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n, =€,| C(CạC,C, - S,S¿) - S;52C¿] - S,(S,CC, + C,S%,) 
n, = S;[C¿(C,C¿C; - S¿S5,) - S:§,C¿] + Cj(S,C¿Cs + C,5,) 
n,= -§, (CC4C, - S,%,) - C,S.C, 

s,= €;I-C,¿(C;C/S,+ S,C2) + S;S¿5,) - S,(-S,C¿S, + CC) 
sy = S/(-C;(C,C¿S¿+ § ,C¿) + S;S,S,] + C¡(-5,CC, + C¡C2) 
s,= Š;(C¿C¿5¿+ S ;C¿) + CạS,S, 


a,= Cị(C¿C,S, + S;C,) - S,S,S: nói 


à, =5, (CS, + S;C:) + C,§,S; 
a,=- SC,5. + CC: 

p. = €C,S;d: - S,d; 

py= 5,5d› + Cịd, 

p,= C;d; 


Nếu biết được giá trị của biến khớp, thì vị trí và hướng của bàn tay 
robot sẽ tìm được bảng cách xác định các giá trị các phần tử của Tự theo 
các phương trỉnh trên. 

Các phương trình trên gọi là hệ phương trình động học của robo. 

4.6.2. Hệ phương trình động học của robot ELBOW: 

Để hiểu rõ hơn về cách thiết lập hệ phương trình động học của 
robot, ta xét thêm trường hợp robot Elbow (hình 4. ! 5). 


đâu 2 Kiểu ở 


Khẩu# 


Hình 4.15. Robot Elbou 
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vÀ 


Hình 4.16. Vị trí bạn đầu của robot Elbou uà các hệ toa độ 


Bảng thông số DH của rôbot Elbow 


= 
Khâu 6y Dn à, ú, 
- Ị 
l 6, 90" 0 0 
+ † —— + 
2 6; 0 âạ 0 
† —t H BI BS : 
3 9; 0 a lÙ 
-| —>— 
4 6, -90' à, 0 
= PP ¬ 
5 0, 90 0 0 
r { II L 
6 Ố, lÚ 0 0 
l§ -L. 
* - các biến khớp 
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Các ma trận À, của robot Elbow được xác định như sau: 


là 0 $0 Œ -®% 0 Ga, 
% 0 =Œ 0 §,..C, 'ÚU Sứ 
A,=| 1l BÁC 
¡0 100 00 1 0 
L0 0 0 0| |. j0. 6 1 
|G -5; 0 Ga| €0 =6 Cu 
_= 5 G0 S5 A,= 5, 0Ú CC 6 
"0 0 1 0 0 -] 0 0 (4.28) 
ƒ" “đt 201: SĨ 0 0 0 1 
É 0$ 0l ỊG —% 0 0Ì 
§ 0 —Œ 0 Š% Œ 0 0 
Nà s A,= 6 6 
: K L0 0 b0 0 10 
|6: 0Ø: ở ¡1 0 0 01, 


Xác định các ma trận 'T, theo các hệ tọa độ lần lượt từ khâu cuối 
trở về pốc: 


lŒ —& 0 0 
§ sa... 
1= 
0 0 I0 (4.29) 
0 0 0l 
ŒŒ -Œ®%, %, 0| 
`» `. 6... 
4m _—_ N.~. s%s § 
1= 4Á, mĩ"... .. (4.30) 
0 0 0 1 
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. GŒG —6j — €5, T542 Cáo; Cạớ 


_ SG +5 5/9, 4+ CÓ, S45; S2, 
VAT xá ÑÑ Œ 0 1431). 
L 0 0 0 1 


.... 
) I5 +G¿% —¬5; 1Á SÐ; 5; hộ 
T=ÁAAA S, hn "..c 
sữ s1 
0 0 0 ] 


T,EÁAAAA,= 
G;£¿C 54% —Gas£z%T—5;;4 Gš¿; G;@u+C v4 t+Ó@, 
Ä-Í Si +, 5% 1C S9: S4 +5 +9, (4.33) 


= SG S5 lề 0 
L h 0 0 { Ị 
Cuối cùng: 


1 ¬ Ấy ỳ H 

1= P _Í= AI 
HS. dd. Ð. “ (4.34) 
0 0 0 1 


Để tính Tự phải nhân A, với "T, sau đó cân bằng các phần tử của 
na trận T, được một hệ thống các phương trình sau: 
l10 


nụ = C(C;aCsCc - 3z; 3¿) - SỊ S:Cu 


n = Š¡(C2C;C, - S229¿) + CSCG 
n, = S;.CŒ, + CS, 
S.=-C,(C,:,C¿S⁄+ S:,C,) + S55, 
S= -Si(C C5 + S;uC,) - CịSsS 
S„=-S;CcS¿+ C;¡jCi (4.35) 
da. =€Œ,©;¿,S;. + S,C¿ »> 

ay, = S.Cš¿Š; - CCs 
du ~ SuyŠ 


pP.= C,(Œ:¿a¡+ C¿ša¿+ C;a, 


Dy= S/(;¿¿2¿ + C;àa: + C;a;) 
P,= 3; + 5;iá:+ 5â; _j 
Nhán xét 


Thiết lập hệ phương trình động học là bước rất quan trọng để có 
thể dựa vào đó để phân tích sự hoạt động của robot và lập trình điều khiển 
robot. 


Nếu cho trước các giá trị của biểu khớp thay đối theo thời gian, thì 
vị trí và hướng của bàn kẹp robot trong mọi thời điểm sẽ hoàn toàn xác 
định từ hệ phương trình động học nói trên. Đó là nội dung chủ yếu của 
bài toán động học thuận. Còn bài toán động học ngược thì lại nhằm xác 
định giá trị của các biến khớp theo các thông số trạng thái đã biết của " 
điểm tác động cuối". Để xác định được các giá trị đó cũng xuất phát từ 
việc giải hệ các phương trình động học nói trên. 


Phương pháp thiết lập hệ các phương trình động học, trình bày 
trong chương này, có thể áp dụng cho robot n bậc tự do. Tuy nhiên n < 6 
là những trường hợp thường gập trong công nghiệp. 


Việc tính toán các ma trận 7T, để thiết lập hệ các phương trình 
động học của robot, như đã thấy ở phần trên, là việc mất rất nhiều thời 
gian và dễ nhầm lân. Bởi vậy sẽ rất có ý nghĩa nếu sử dụng máy tính để 
tính toán các ma trận nói trên với lời giải không phải bằng số mà bằng 
các biểu thức giải tích. Trong [39] chúng tôi đã trình bày một chương 
trình tính toán như vậy để thiết lập các phương trình động học của robot ở 
đạng các biểu thức giải tích đã rút gọn. Sau đó đã cải tiến chương trình 
này bằng cách áp dụng MATLAB. 


Để sử dụng chương trình tính toán này chỉ cần đưa vào bảng 
thóng số DH của robot. Ví dụ, đối với robot Elbow ta đã thiết lập bằng 
thông số ĐH như trên và kết qủa tính toán sau đây in ra từ máy tính để so 
sánh với kết quả tính toán bằng tay ở phần trên. 

Đối với một số kiểu robot khác được giới thiệu ở các phần sau, 
đều sử dụng chương trình máy tính này. 


Thiết lập phương trình động hoc của robot Elbow: 
Số khớp n =6 


Ma trần : A(6) 


+CÓ6 -S6 0 Q Si 
+56 +CŒ6 0 0ö 

0 Š) +Ì ÔÖ 

0 0 0 + 


Ma trận BDODN : T6) = A(6); 
Ma trận : A(Š5) 


+C5 0 +S5 0 
+S5 0 -C5 Ệ) 
0 +Ì 0 lệ) 
D lỆ) 0 +Ị 


Ma trận BDDN T(4.6) = A5*T(@,6) 


Td.1) = C5*C6; 
T(1.2) = -C5*§6; 
TỢ,3) = S5; 
T4) =0; 
T(2.L) = S5*C6, 
T(,2) = -S5*§6; 


TẠ,3) = -C5; 
T124) =0; 
T,1) = %; 
T@,2) = Có; 
T(3,3)=0; 
T.4)=0; 
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Ma trận : A(4) 


+C4 0 -%4  +C4a4 
+&4 0 +C4 +S4a4 
0 -] 0 0 
0 0 0 +] 


Ma trận BDDN T@.6) = A4*T(46) 


TÚ,L) = C4#CS*Có-S4*S6, 
T(1,2) = -C4*C5*S6-S4*Có; 
T(1,3) = C4*§5; 

T(1,4) = C4*a4;, 

T(,1) = 54*C5*Có+C4*56; 
T(.2) = -%⁄4*C5*S6+C4*C6: 
T(2.3) = S455; 

TỢ.4) = S4*a4, 

T(3,L) = -S5*Có; 

TO.2) = S5*%6; 

T,3) = C5: 

TG,4) =0; 


Ma trận : A3) 


+C2_ -§S3 0 +C3a3 
+83 +C3 0 +S3a3 
0 0 + 0 
0 0 0 +l 


Ma trận BDDN T(2,6) = A3*T,6) 


T(1,1) = C34*C5*XC6-S34*%6; 
T(1,2) = -C34*C5*%-S34*Œ6; 
T(1,3) = C34*S5; 

T(1,4) = C34*a4+C3*a3; 
TƠ,1) = S34*C5*Có+C34*S6; 
T(.2) = -S34*C5*S6+C34*CŒ6; 
T(.3) = S34*§5; 

T,4) = 534*a4+S3*a3; 
T13.,I) = -S5*Œ€; 

T(3,2) = S5*S6; 

T@.,3)= C5; 

T(3.4) = 0: 
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Ma trận : À(2) 


[l¿Œ@ S2 0 +C2a2 
+82 +C2 0 +8242 
lộ) 0 +I 0 
0 0 0 +1 


Ma trận BDDN T(1,6) = A2*T(2,6) 


T(1,1) = C234*C5*C6-S5234*S6; 
T(1.,2) = -C234#C5*S6-S234*Œ6; 
T(1.3) = C234*SS: 

T(1.4) = C234*a4+C23*a3+C2*a2; 
TÓ.1) = S234*C5*C6+C234*S6: 
TO.2) = -S234*C5*S6+C234*C6: 
T(2,3) = S234*§5; 

TÓ.4) = 5234*a4+S23*a3~+S2Xa2; 
TÓ.1) = -S5*Œ6; 

T,2) = S5*%6: 

T(3,.3)= C5; 

T(3,4)=0; 


Ma trận : A(U 


+C[| Q +ŠSI 0 
+5] 0 -CI 0 
0 +Ì lộ) 0 
0 0 0 +l 


Ma trận BDDN T(0,6) = AI*T(1,6) 
Hay hệ phương trình động học của robot Elbow. 


Nx = CI*(C234*C5*C6-S234*S6)-SI*S5*C6; 

Ox = CI*(-C234*C5*S6-S234*Œ€6)+S1*S5*S6; 
Ax = CI*(C234*S5)+SI*C5; 

Px = CI*(C234*a4+C23*a3+C2*a2); 

Ny = SI*(C234*C5*C6-S5234*§6)+~CI*S5*GŒ6; 
Oy = SI#(-C234*€5*S6-S234*C6)-CI *S5*S6; 
Ay =SI*#(C234*S55)-CI*C5; 

Py = SI*(C234*a4+C23*a3+C2*a2); 

Nz = S234*C5*C6+C234*$6; 

Oz = -S234*C5*S6+C234*CŒ6; 

Az = 5234†55;, 

Pz = 5234*a4+S23*a3+S2*a2 
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4.6.3 Hệ phương trình động học của robot Adept One. 


Robor Adept One là sản phẩm của Liên hiệp Công nghệ Adept 
(Mỹ) sản xuất. Đó là một kiểu robot thuộc loại SCARA ( xem hình 4.7). 
Robot Adept Ône tuy ra đời mưộn hơn nhưng đã được ứng dụng tương 


đối rộng rãi trong công nghiệp, trước hết là đo kết cấu đơn giản. 


Hình 4.17 là mô hình Robot Adept One cùng các hệ toa độ gắn 
liền với các khâu. Còn trong bảng sau đây là bộ thông số DH của robot 


Adept Ông 
Thông số DH của robot Adepr One 
Khâu | 6, SN a, đ, Khớp 
— l 6`, 0- â, dc — R 
PC sói 2 đƠẾ) 180 Ì —a, —Ũ =Í 
| 3 lộ 0. Ø để 
| 4 "¬¬ 0 0 dụ R 
*- các biến khớp vs ' 


Ở trang tiếp theo trình bày kết quả thiết lập hệ các phương trình 
động học robot Adept One bằng máy tính. 


Hình 4.17. FRobot Adept One 


I15 
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Thiết lập phương trình động học của robot Adept one. 


Số khớp n= 4 
Ma trân : A(4) 
+C4 
+8 
0 
0 


Ma trận BDDN : T@,4) 


Ma trận : À(3) 
+Ì 
lÐ) 
lÔ) 


-34 lộ) Â) 
+Œ€4 0O 0 

lÂ) +Ì +d4 

0 0 +I 

= A(4); 

0 Ñ) 0 
+] Ñ) 0 

D0 +l +d3 


Ma trận BDDN 1,42 = A3*T(3,4) 


T(1,1) = C4; 
T(.,2) = -5 
T(1.3) = 0; 
T(1,4)=0; 
TŒ@.L) = %% 
TŒ@,2) = C4; 
T(,3) = 0; 
TŒ@.4) =0; 
T(3,1)=0; 
TQ,2) =0; 
T(3,3) = l; 
T,4) = d4+d3; 


Ma trận : A(2) 


+C2  +S2 0 +C2a2 
+82  -C2 0 +S2a2 
9) 0 ¬ 0 
Ó 0 0 +l 


Ma trận BDDN T(1,4) = A2*T(2,4) 
T(1,L) = C2*C4+S2*S1, 


T(1,2) = -C2*S4+S2*C4, 
T(1,3) = 0; 


T(1,4) = C2*a2: 

T(2,L) = S2*C4-C2*S4; 
TƠ,2) = -S2*S41-C2*C4; 
T@.3) =0; 

TƠ.4) = S2*a2; 
TQ@.,})=0; 

T(3.2)›)=0; 

T(3.3) =-I: 

T4) = -(d4+d3); 


Ma trận : A(1) 


+CI  -Š5I O +Clal 
+Ãl  +C]l 0 +Slal 
l§ 0 +l  +ải 
lÐ) 0Ö 0 +l 


Ma trận BDDN T(0,4) = A1*T(1.4) 
Hay, hệ phương trình động học cửa robot Adept Ônc. 


Nx = CI2*C4+S12*S4; 
Ox =-C12*S4+512*€C4: 
Ax=Ô: 

Px =CI2*a2+ClI*al; 
Ny = SI2*C4-CI2*S4; 
Oy =-Š12*§4-CI2*C4; 
Av = Ô; 

Py = SI2*a2+S1*al; 
Nz=0; 

Oz=0. 

Az=-l; 

Pz¿ = -(d4+d3)+dl; 


4.6.4 Hệ phương trình động học của robot Puma, 


Robot Puma là sản phẩm của Công ty Unimate (Mỹ). Đó là loại 
robot được dùng rộng rãi ở nhiều nước, 


Trên hình 4.18 là mô hình robot Duma với các hệ toạ độ đã chọn. 
Còn trong bang sau là bộ thông số DH của robot Puma. 


Thông số DH cửa robot Puma 


Khâu 8, ì Ơ, A — | đ 
": 0, -907 0 — 0 Í 
Ề Ï 
SE. Là ö ä đ› ị 
3 B; †_ 9% N Eux si 

4 ũ, -90 mi TT cụ 

$ 6, | _ 90 0 0 
Ì 6— 0` 0 0 l du 4 
L* - các biến khớp ` ' 


Ở trang tiếp theo trình bày kết quả. thiết lập hệ các phương trình 
đóng bọc robot Puma bằng máy tính. 
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Hinh 4.18. Fobo! Puma 


Thiết láp phương trình động học của robot Pưma: 
Số khớp n= 6 


Ma trân : Á(6) 
+Cé  -S6 0 0 
+S% +C6 0 0 
0 0 +l +đố 
ö 0 0 +l 


Ma trận BDDN : 7(5,6) = A(6); 


Ma trận : A(5) 


Ma trận BDDN T(4,6) = A5*T(5,6) 


T(1,1) = C5*Có; 
T(1,2) = -C5*S6; 
T(1.3) =S5; 
T(1.4) = S5*đ6; 
T@,1) = S5*Œ6; 
TÓ,2) = -S5*S$6; 
12,3) = -C5; 
T(2.4) = -C5*d6; 
TƠ,1) = %; 
T1,2) = C6; 
T@.3)=0; 
T,4) =0; 


Ma trận : A(4) 
+C4 0 -%1 0 
+S4 0 +C4 0 


Ma trận BDDN T,6) = A4*T(4,6) 


T(1,1) = C4*C5*C6-S4*56; 
T(1.2) = -C4#C53*S6-S4*C6; 
T(1.3) = C4#S5: 

T(1,48) = C4#S5*d6; 

TŒ,L) = S4*C5*Có+C4*S6; 
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TŒ,2) = -54*C5*S6+C4*G6; 
12.3) = 54*55, 

T(2.4) = S4*S5*dó; 

T@,L) = -S5*C6; 

T(4.2) = S5*S6, 

T(3.3) =5; 

T(3.4) = C5*d6+d4; 


Ma trận : A(3) 
+C3 0 +S3 +C3a3 
+83 0 -C3 +S3a3 
m +l 0 lộ) 
0: ð- 6 + 


Ma trận BDDN T(.6) = A3*T(3,6) 


T(1,L) = C3*(C4*C5*C6-54*S6)-S3*S5*C6, 
T(1,2) = C3*(-C4*C5*S6-S4*C6)+S3*§5*Só, 
TÍ1.3) = C3*C4*S5+S3*C5: 

T(1.4) = C3*C4*#S5*d6+S3*(C5*d6+d4)+C3*a3; 
T(2,1) = S3*(C4*C5*C6-S4*S6)+C3*S5*C6; 
T(.2) = S3*(-C4*C9*S6-S4*C6)-C3*S5*S6: 
1(2.3) = S3*C4*SS5-C3*C5; 

T(2.4) = S3*C4*S5*d6-C3*(C5*d6+d4)+S3*a3: 
T,1) = S4*C5*C6+C4*§6; 

T(3.2) = -S4*C5*S6+C4*C6: 

T(3.1)254°65. 

T(3.4) = S4*S5*d6; 


Ma trận : Á(2) 
+C2 -S2 0 +C2a2 
+52 +C2 0D +52a2 
lô) 0 +l  +đ2 
0 0 0 + 


Ma trận BDDN T(1.6) = A2*T(2.6) 


T(1,L) = C23*(C4#C5*Cá-S4*S6)-S23*S5*C6 

T(1,2) = -C23X(C4*C5*#S6+S4*C6)+S23*S5*56 

T(1,3) = C2*(C3*C4#S5+S3*CS)-S2*(S3*C4*S5-C3*CS5) 

T(1,4) = C2*(C3*C4#S5*dố+S3*(C5*dó6+d4)+C3*a3)- 

- 52#(S3*C4*S5*d6-C3*(C5*d6+d4)+S3*a3)+C2*a2 

TƠ.I) = 52*(C3*(C4*C5*C6-S4*S6}- 33755”C6)+C2*(53*(C4*C5%G6- 
-54*S6)+C3*S5*C6) 

T@.2) = S2#(C3*(-C4*C5*S6-S4*C6)+§S3*S5#S6)+C2#(53*(- ;höbe 0 sa 

-94#C6)-C3*S5*S6) 
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TƠ,3) = 52*(C3*C4*S5+S3*C5)+C2*(S3*C4*S5-C3*C5) 

T24) = 
S2*(C3*C4*S5*#d6+S3*(CS*#d6+d4)+C3*a3)+C2*#(S3*C4*S5*đ6- 
-C3*(C5*d6+d4)+S3*a3)+S2*a2 

T1(3.L) = S4*CS5*C6+C4*S6 

T3.2) = -ŠS4*C5*S6+C4*C6 

I(3.3) = S4#SS; 

T(3.4) = S4*S5*d6+d2; 


Ma trận : A(l) 


+C] 0 -SI 0 
+SI 0 +Cl 0Ô 
0 -| 0 0 


Ma trận BDDN T(0.6) = A1#T(1,6) 
Hay hệ phương trình động học của robot Puma: 


Nx = CI*(C23*(C4*CS#C6-S4#S6)-S23*S5*C6)-S1*(S4*C5*C6+C4*S6) 
Ox = CỊ*(-C23*(C4*C5#S6+S⁄1£C6)+523*S5*S6)-SI 
*(-4*C5*S6+C4*C6) 

Ax = CI#(C2*#(C3*C4*SS+S3*C5)-S2*(S3*C4*#SS-C3*C5))-S1*S%4#*SS 
Px = CI *(C2*(C3*C4*S5*đ6+53*(C5*d6+d4)+C23*a3)- 
-52*(S3#C€4*S5*đ6-C3*(C5*dó+d4)+S3*a3)+C2*a2)-SI*(S4#S5*d6+d2) 
Ny = 5I*(C23*(C4*C5*C6-S%1*S6)-S23*S5*C6)+ 
+CI*(S4*C5*C6+C4*S6) 

Oy = SI*(-C23*(C4*C5*S6+S4*C6)+S23*S5#*S6)+C] 
*(-54*CS*Sö+C4*C6) 

Ay = SI#(C2?(C3#C4#S5+S3*C5)-S2*(S3*C4*S5-C3*C5))+CI*S4*S5 
Pv = SI*(C2*(C3*C4#S5*d6+S3*(CS*d6+d4)+C3*a3)- 
-Ss2*(S3*C4*SS*đ6-3*(C5*d6+d4)+S3a3)+C2*a2)+C1*(S4*S5*d6+d2) 
N¿ = -(S2*(C3*(C4*C5XC6-S4#S6)-S3*S5#C6)+C2*(S3*#(C4*CS*C6- 
-S4*56)+€3*S5*C6)) 

Óz = -(S2#(C3#(-C4*C5*S6-S4*C6)+S3*S5*S6)+C2*(S3*(-C4*C5*S6- 
~54*C6)-C3*S5*S6)) 

Az = -(S2*(C3*#C4*S5+S3*C5)+C2#(S3*C4*SS-C3*C5)) 

Pz = -(S2*(C3#C4*ZS5*d6+S3*(C5#d6+d4)+C3*a3)+C2*(S3*C4#S5*d6- 
-C3*(C5*d6+d4)+S3*a3)+S2*a2) 
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CHƯƠNG V 


TỔNG HỢP CHUYỂN ĐỘNG ROBOT 


51L. NHIỆM VỤ TỔNG HỢP CHUYỂN ĐỘNG CỦA 
ROBOT 


Ở chương trước chúng ta đã khảo sát bài toán phân tích động học 
robot; cho trước chương trình chuyển động cần xác định quy luật thay đối 
của các thông số động học đặc trưng cho sự chuyển động của các khâu. 
Chương tình chuyến động được biểu thị bằng hàm q(0), (¡ = l..... n). với 
q, là toa độ suy rộng hoặc là biến khớp. 


Ở chương V_ này chúng ta tiến hành xây dựng phương pháp giải 
bài toán tổng hợp chuyển động của robot. Nhiệm vụ tổng hợp chuyền 
động bao gồm việc xác định bộ lời giải q, (8), (¡ = I...., n) sáo cho bàn kẹp 
cửa robot thực hiện được các chuyển dịch trước. 


Các bài toán tổng hợp này rất đa dạng, tuỳ thuộc các yếu tố sau 
đây: 


- Sự chuyển địch trước đó ở dạng nào: dạng quỹ đạo hay phương 
trình nào đó; biết điểm đầu, điểm cuối hay biết một số điểm trung gian 
trên đường đi v.v.. 


- Chi th trước các vị trí liên tiếp của bàn kẹp hay là cả định 
hướng của nó 

- Có những hạn chế gì trong quá trình chuyển động của robot. 
Thông thường có 2 loại hạn chế: 

1) Do kết cấu của robot mà có thể hạn chế phạm ví thay đối vẻ giá 
trị của biến khớp hoặc của vận tốc và gia tốc chuyển động. 

2) Do mối trường hoạt động có yên cầu THỊng va chạm vào các 
Vật xung quanh. 

- Số bậc tự do của cơ cấu robot như đã phân tích ở trên có thể dư 
thừa hoặc không và bài toán có thể có lời giải đa trị hoặc đơn trị. 


Biết quy luật chuyển động của bàn kẹp. cần xác định quy luật tha? 
đổi các biên khớp tương ứng. Đó là nội dung chính của việc tổng hợp quỷ 
đạo chuyển động robot. 
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Có thể xem quỹ đạo chuyển động là tập hợp liên tiếp các vị trí khác 
nhau của bàn kẹp. Trong thực tế cũng chí cản xét lại một số hữu hạn các 
vị trí trên quỹ đạo. Tại mỗi vị trí trên quỹ đạo cần xác định bộ thông số 
các biến khớp q,. Đó là nội dung của bài toán động học ngược ( Invetse 
kinematies problem) của robot. 


5.2. Hài toán động học ngược 


Bài toán động học ngược được đặc biệt quan tâm vì lời giải của nó 
là cơ sở chủ yếu đế xây dựng chương trình điều khiển chuyển động của 
robot bám theo quỹ đạo cho trước. Có nhiều công trình nghiền cứu tìm lời 
giải cho bài toán này. Đối với trường hợp n > 6 thì hầu như chỉ có lời giải 
theo phương pháp số đối với một số loại robot cụ thể nào đó, nhưng chưa 
có một phương pháp chung nào có hiệu quả cả. Bản thân việc giải bài 
toán động học ngược bảng phương pháp số nhiều khi đòi hót thời gian 
tính toán kéo dài, thậm chí không đi đến lời giải. Sở dĩ như vậy là vì 
thường gặp các hệ phương trình siêu việt không phai lúc nào cũng có độ 
hội tụ lời giải. Điều đó ảnh hưởng lớn đến việc đảm bảo thời gian thực 
trong điều khiển robot. 


Đối với trường hợp n = 6, là trường hợp thường gặp trong thực tế 
công nghiệp nên có nhiêu công trình nghiên cứu hơn.Tuy nhiên, ở đây 
các lời giải tìm được hầu như chỉ cho trường hợp riêng, có đặc điểm hình 
động học riêng biệt được tận dụng để thiết lập các quan hệ cần thiết khi 
thiết lập lời giải. Trong đó nên lưu ý đến các công trình sau: [7] giải bài 
toán động học ngược của robot Purna theo phương pháp hình học; đặc 
biệt là công trình [12] đùng phương pháp biến đối ngược các ma trận 
thuần nhất 4x4, áp dựng cho robot Stanford. Nhược điểm của phương 
pháp này là chưa có cách chung để xác định một lời giải có thể thích hợp 
ngay trong số khá nhiều lời giải có thể tồn tại. 


Trong [35] đã tiến hành độc lập việc thử tìm một phương pháp 
giải cho trường hợp robot n bậc tự do. Còn trong {38 ] lại để xuất một 
phương pháp thực dụng, gọi tên là phương pháp "các nhóm 3”. 


Xuất phát từ phương trình động học cơ bản (4.5) ta có: 


Hs ca SP, 

TueS/l 4 soi S @.) 
H. `; đ. P. 
0 9 0 1 


Các ma trận Á,(I = 1.2,... n) là hàm của các biến khớp q, Véctơ 
định vị bàn kẹp hoặc ” điểm tác động cuối” p = (p, p, p,)` cũng là hàm 
của q,. Các véctơ n, s, a là các véctơ đơn vị chỉ phương các trục của hệ toạ 
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độ gắn liền với bàn kẹp hoặc ” điểm tác động cuối” biểu điền trong hé toạ 
độ vỏ định XYZ. Các véctơ này vuong góc với nhau từng đôi một, cho 
nên trong 9 thành phần của chúng tồn tại độc lập chỉ có 3 thành phân, 


Hai ma trận ơ vế trái và ở vế phải của phương trình (5.1) đều là 
các ma trận thuần nhất 4x4. So sánh các phần tử tương ứng của 2 ma trận 
trên ta có 6 phương trình độc lập với các ẩn số q, (¡ = 1/2, ..n). Có 3 
trường hợp có thể xảy ra: 


- Nếu số ẩn số (thường cũng là số bậc tự do của cơ cấu robot) n< 6 
thì lời giải không hoàn chỉnh. tức là lúc này cơ cấu robot không đưa bàn 
kẹp tới vi trí và định hướng như mong muốn được hoặc có thẻ, ví dụ, đạt 
tớt vị trí nhưng không thoa mãn yêu cầu về định hướng. Trường hợp này 
có thể áp dụng khi không có yêu cầu hoàn chính vẻ các thông số định vị 
và định hướng cua bàn kẹp. 


- Nếu n = 6, tức là số ẩn số bằng sỏ phương trình thì bộ biến khớp 
q,+ q, hoàn toàn xác định. Tuy nhiên, lời giải không phải lúc nào cũng để 
dàng tìm ra. Bởi vì, nói chung các phương trình này có thể là siêu việt và 
hệ phương trình siêu việt này không phải lúc nào cũng cố độ hội tụ của 
lỜi giải. 

- Nếu n > 6, tức là số ấn số lớn hơn số phương trình thì có khả năng 
có nhiều lời giải. tức là cùng đạt tới một vị trí và định hướng của bàn kẹp 
có thể có nhiều bộ thông số biến khớp q,. 

Xuất phát từ ý muốn để độ cơ động của robot nâng cao, tức là hoạt 
động linh hoạt hơn thì cơ cấu chấp hành như một cơ cấu không gian, phải 
có nhiều bậc tự do hơn 6. Khi đó cơ cấu robot có thể có nhiều phương án 
để đặt tới đích. Điều đó cũng rất cần thiết, nhất là khi môi trường làm 
việc có các chướng ngại vật. Tuy nhiên lúc này lại nảy sinh khó khăn 
trong tính toán vì sự đa trị của lời giải. Nhiều trường hợp máy tính không 
chọn được lời giải thích hợp hoặc chọn quá lâu nên không thể quyết định 
kịp thời các giá trị của biến khớp để điều khiến chuyển động cúa robot. 
Sở di như vậy là dơ khi giát bài toán thường gặp các hệ phương trình siêu 
việt, như đã nói, không phải lúc nào cũng có lời giải. Ngoài ra có những 
lời giải không được xem là thích hợp nếu chúng vượt ra ngoài phạm vị 
hạn chế của các biến khớp, tuỳ thuộc kết cấu cụ thể của robot. 


5.3. CÁC PHƯƠNG PHÁP GIẢI BÀI TOÁN ĐỘNG HỌC 
NGƯỢC. 
5.3.1. Trường hợp robot n bậc tự do 


Như đã đẻ cập ở phần trên, khi giải quyết nhiệm vụ tổng hợp quỹ 
đạo chuyển động của robot thường nhiều lần phải lặp lại việc giải bài toán 
động học ngược .Trong khá nhiều trường hợp giải bằng phương pháp số 
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lại khóng xác định được lời giải thích hợp. hoặc thời gian tìm kiếm lời 
giải quá lâu do gặp khó khăn như giải hệ phương trình siêu việt, hoặc vì 
tính đa trị của lời giải cũng như sự đa dạng của các cấu hình trung gian 
của cơ cấu robot. Vì vậy có nhiều công trình nghiên cứu để tìm lời giải 
cho các bài toán động học ngược ở dạng công thức. Hầu hết các phương 
pháp đều dùng cho các trường hợp cơ cấu robot cụ thể nào đó và tất cả 
đều là trường hợp từ 6 bậc tự đo trở xuống. 


Nội dung phương pháp trình bày dưới đây là đối với trường hợp 
robot n bậc tự do [35]. 


Vẽ trái của phương trình (5.L) theo cách ký hiệu như (4.7) © (4.9) 
có the viết lạt như sau: 


TP, (5.2) 


Nhân hai vế của (5.2) với T/” ta có: 


TIT,=!T, vàu TẾ =(A,4,...A4) 0 =A.'...4'A 


ta có: 
A-`..A4;`Ay T, =' T, (5.3) 
Kết hợp với (5.1) ta có: 
1y s. 4. ĐV 
JSC Vy ` _ : : Sẽ 
0 | 


với 1 thay đối từ ¡ đến n-Ï. 


Ứng với mỗi giá trị của ¡, khí so sanh các phần tử tương ứng của 2 
ma trận ở 2 vế của biểu thức (5.4) ta có 6 phương trình tồn tại độc lập để 
xác định biến khớp q,. 


Như thế, bằng cách đó có nhiều khả năng để lựa chọn các bộ lời 
giải q, đa trị này. Trong nhiều trường hợp từ hệ các phương trình này có 
thể xác định q, bằng các biểu thức giải tích. Việc này rất quan trọng, nhất 
là khi cản nhanh chóng có lời giải để đảm bảo thời gian thực trong điều 
khiển robot. Tuy nhiên cũng phải tuỳ thuộc vào loại cơ cấu robot cụ thể 
mới nhận biết được từ các phương trình nào trong hệ các phương trình 
này có thể tìm được biểu thức tính q, ở dạng công thức. 


5.3.2. Giải bài toán động học ngược của robot Stanford { L2] 


Hệ phương trình động học của tobot( Stanford đã được thiết lập 
trong phần (4.6.1). Robot Stanford có 6 bậc tự do. 


Từ biểu thức (5.3) ứng với ¡ =1+ 5, lần lượt ta có: 


'-T10 VỆ ĐớE) (5.5) 

Âu TÀU "Ty An, (5.6) 
A¿'Az'Ar'T,=ÝT, (5.7) 

A,'A CA. AT, = T, (5.8) 
SÁU ĐÁ ĐÀO ÁI Tác by (5.9) 


* Sử dụng các biều thức tương ứng đã có trong phần (4.6.1) tính 
vế trái của phương trình (5.5): 


Ôạ sốu, TÔ 0| [n_ s, a, p.| 
0 


|Cin, +8mm, C,§,+8¡5,  C¡a +S¡a, C,p,+S,p, | 
Ì! a s = = 
A, Tự= h, , A, P, (5.11) 
S,n,+€,n, S5, + Cj§, Sia, tC¡a, SP, +C,P, 
0 0 0 0 


Vẽ phải của (5.5) là ma trận (4.25) đối với "Tạ. So sánh các phần 
tử ở hàng 3 cột 4 của 2 ma trận (5.I L) và (4.25) ta có: 


- SP, + Cịp, = d; (5.12) 

Thay thế: 
ƒf,=rcos Ð - và Øy=T sim È (5.13) 
trong đó: r= +xjp; + Py (5.14) 
$ = arctg 2 (P,, P,) (5.15) 


vào (5.12), ta có: 


sin $cos Ô, -- cos $ sin Ô, = —^~ (5.16) 


Xút: 0<-^<l 


hay là: 
sin($ —9,) = si 
lộ 
với 0<($-Ð,)<m (5.17) 
từ đó: 


cos(Ø - đ,) = + ANH 
r 


Trong đó dấu trừ (-) phù hợp với hình thể vai trấi của robot và 
dấu cộng phù hợp với hình thể vai phải của robot (hình 4.13). 


Cuối cùng ta có: 
6, = aretg2(p,.,p,)— aretg2(d,,+\|rỶ ~ d‡) (5.18) 
* Tiếp theo, cho cân bằng các phần tử ở hàng l cột 4 và hàng 2 
cột 4 của 2 ma trận (5.11) và (4.25), ta có: 
5d; = Cịp, + SIPy (5.20) 
°.° Ấm... (5.21) 


đ, là độ dịch chuyển dài của khớp tịnh tiến, đ. > 0. nên từ ( 5.20) và 
(5.21) ta có: 


= arctg 2 (CỊP, + S¡py, D¿) (5.22) 


Từ phương trình (5.6) và tính A, ',A; từ (4.20), ta có vế trái là 
một ma trận có dạng sau: 


f,(n) f,„@) ma) 0 
f;„(n) f;;(S) f;;(a) 0 2 T 
~ 5.23 
[;n) f;@) l¿(4) B;(p) ( ) 
0 0 0 ] ] 
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Trong đó ký hiệu rút gọn: 
đi = Ca(LẨ + S3) Kai Š;Z 


đa =—=Šx† Cự (5.24 
S2(Clx + ðry) + ;Z | ` 


tí 


£ 
⁄3» 
và x, y. z trong các ký hiệu đó tương ứng là các thành phần của các vectơ 
n, s. a và p viết trong dâu ngoạc đơn, ví dụ: 
#¡,(n) = C,(Cn, + Sin,)= Sàn, 
#!¿(š) =-ñx, +4, 
J5;(4) = =Sa, + Cai 
Còn vế phải của (5.23) là ma trận (4.24), 


Cần băng các phần tử ở hàng 3 cột 4 của 2 ma trận ở vế trái và ở 
vế phải của (5.23), ta có: 


đ,= S;( Cịp, + S¡p,) + GP, 
(5.25) 


* Tiếp theo, triển khai phương trình (5.8), thực hiện phép nhân các 
ma trận ở vế trái và biểu diễn ở dạng ký hiệu rút gọn như sau: 


4⁄10) 4) /(4) 0 


/#a(") /¿() /ạ(4 01, 
banh: đc : 
#a(@) 2G) J7:(a) 0 (5.26) 
0 0 g:- <1 
Trong đó: 


đi = C[C;(Cx + Šy)~ Š2z]+ S.(—S,x + Cịy) 
tạ = =8;(Cx + Šy)— C;z (5.27) 
#q = —5,[C;(Cx + 5;y)T S:Z]+ Cu( 8x + Cty) 


Cân bảng các phần tử hàng 3 cột 3 của 2 ma trận ở hai vế của 
(5.26) với “Ï, là ma trận (4.22), ta có: 


†,;(a) = 0 
Hoặc 


-5 {C,(C¡a, + S;a,) - Sa} + Cạ(- S;a,+ Ca) = Ô (5.28) 
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Đây là phương trình lượng giác có dạng: 
-Sin $ a, + cOS ÿ ay = Ö 


Như đã giải trong các phần trước đây. phương trình (5.28) có 2 
nghiệm: 


Ô,= arctg 2 ( -S¡a, + Cịa,, C( Cịa, + S. A,) - Sza,) 3ó 
và 8, = Ð,+ 180! 
- (hiểu theo cách viết khi lập trình trên máy tỉnh), 


Nếu các yếu tố của hàm (5.29) tiền tới Ô thì rơi vào tình trạng suy 
biến như đã nói ở mục (3.4.2). 


Cũng có thể tìm giá trị của biến khớp 6, bằng cách cân bằng các 
phần tử ở hàng 1 cột 3 và hàng 2 cột 3 của phương trình ma trận (5.23). 


CS, =C,; ( Ca, + Sia,) - Sa, (5.30) 
Š,Š; =-5¡a, + Cia, 
từ đó cũng nhận được kết quả đúng như (5.29): 
Đ, =arctg 2 [ -S,a, + C;a, , C( Ca, + S; a,) - S;a,] 


với 8,>0 
và 0,= ð,+ 180” 
với 8:<0 


Khi S, =0, Ð; = O, robot suy biến do cả hai trục của khớp 4 và 6 
nằm thẳng hàng ( Z; = Z„). ở vị trí này chỉ có tổng 0, + , là có ý nghĩa. 


Khi 9, = 0, có thể tuỳ ý chọn một giá trị nào đó của 8„, thường 
chọn giá trị hiện hành. 


Từ vế phải của phương trình (5.26) có thể nhận được các phương 
trình đề giải S., Cạ„, S„ và Cụ, 


Chẳng hạn khi cân bằng các phần tử hàng I cột 3 và hàng 2 cột 2 
(a Có : 


S; = C, [C; (C¡a, + S¡a,) - S;a, ]+ S, (-S¡a, + Cịa,) 
C; = 5; (Cia, + S,a,) + Cạa, (5.31) 


Từ đó suy ra: 
6; = arctg 2 (C.IC;(C,a, + 5¡ay) - Š;a,] + 
+ Š„ (- Sia, + Cụa,), S;(C¡a, + S¡a,) + Cóa,) (5.32) 
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Tiếp theo, triển khai phương trình (5.9), ta có phương trình biểu 
diễn ở đang ký hiệu như sau: 


f,(n) f,,@) 0 0 
f„(n) f@œ) 0 0 
' l =1. 5.33 
fy(n) f;@) 1 0 tiện 
Ũ 0 0 1 


Trong đó TT, là ma trận (4.21) và: 


#ị = € (GIG(Gx+Sy) = S22] +®S,(¬5x+€y)}+S.|¬5(Cx+Sy) ~Gz] 
#¿ =—SG(Gx+Sy)—®%z]+Œ|-Sx+Gy] 
ƒ) =%{GIG(Gx+&y)—Sz]+S(¬S§x+Œy)}+G[G(Gx+Sy)+Z] 


Cho cân bằng các phần tử ở hàng I cột 2 và hàng 2 cột 2 ta nhận 
được các giá trị của S,„ và Cụ: 


% =-GIGIG(Gs,+Ss,)—&s.]+%¬§s,+Gs)+SIS(Gs,+5,)+Gs}] 
G=¬S|G(Gs,+Ss,)—8s,]+GI¬§s,+Gs,] (534 


Tù đó xác định được: 
6, = arc(g2(S,,C,) (5.35) 
Các biểu thức (5.19), (5.22), (5.25), (5.29), (5.32) và (5.35) xác 
định tệp nghiệm của bài toán đòng học ngược của robot Stanford. 
5.3.3 Giải bài toán động học ngược của robot Elbow [12] 


Hệ phương trình động học của robot Elbow đã được thiết lập trong 
phần (4.6.2) bằng các biểu thức từ (4.28) đến (4.34). Ở đây cũng tiến 
hành theo cách làm như ở phần trên. Trước hết khảo sát phương trình: 


À¡'T⁄=!, (5.36) 


Trong đó 'T, là ma trận (4.33), còn vế trái là ma trận biểu thị ở 
đạng sau: 
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[f,,(n) f@) fn() f0) 
f„(n) f;(s) f:(a) fs(p) ụ 


f,(n) f;@) f;@) f,@)|_ T, (5.37) 
0 0 0 ] 
Dùng ký hiệu tương tự ở trên: 
#ị=Cx+Sy 
dị =Z 
fạ = 5x Cịy 


Cho cân bằng các phần tử ở hàng 3 cột 4 của 2 ma trận ở 2 vế của 
phương trình (5.37), ta có: 


Š¡P, - C¡Py = Ô (5.38) 
Suy ra : 
6, = arctg 2( pypP.) 
và 8.=9,+ 180 (5.39) 


Trong trường hợp robot Elbow, ba khớp kế tiếp đều song song và 
không có kết quả nào nhận được từ các phép nhân ma trận nghịch đảo. 
Cho đến khâu thứ 4, tức là khi có biểu thức sau; 


NỆ NV TA, CAI Ác 12“ —— (940) 
Trong đó T, là ma trận (4.30), và sau các phép nhân ma trận ta 
có. 
tín) fạ@) (a) fj(p)— Ca; —- Ca; =a, 
f,(n) Í,() f;(a) 0 
f(n) f2) Í;(a) f„(p)+ Sa; +5,a; 
0 0 0 | 
Ký hiệu: 
đại = C(Ct + Sy) + Š;¿Z 
đạ ==Six+Cịy 
đ = T5, (Cx + 5y) +2 


=%, 41) 
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Cho cân bằng các phần rử hàng 3 cột 3 của 2 ma trận ở 2 vế 
phương trình (5.41), ta có một phương trình tính Ô.„„; 


~-8;;4 (C(4, + S¡ay) + C;¿„a, = 0 (5.42) 
Suy ra: 
Ô;x„ = arctg 2 (a,, Cịa, + S¡a,) 
và Ô;¿„ = Ô;„ + 180” (5.43) 


Tiếp theo cân bằng các phần tử 2 ma trận (5.37) hàng I cột 4 và 
hàng 2 cột 4, ta có: 


Cịp, + Sipy = Cá, + C;ay + C;a; (5.44) 

P„= Sau, + Say + Sạa; (5.45) 
Đật: 

P,=Cp, + Š.p, - Cua¿ (5.46) 

Dy=P¿- Suuâ¿ (5.47) 
Cộng (5.44) với (5.46) và (5.45) với (5.47), ta có: 

B,= Cai + Ca, (5.48) 

Py= Sai + Sa; (5.49) 


Từ đó ta có: 
pv† Py = (C¿aa; + Ca;}” + (S;¿a; + S;a;)” 
=(SyŸ + C2) ay + (SỬ + C2”) a,ˆ + 2a,a.(C2C, + SšS,) 
Bởi vì: 
CC, + S;;5; = cos(Ð; + Ô; - Ô;) = cosÔ, = C, 
QUY rã: | 


42 2 2 2 
Ð xTPp ... = 
Œ=—————— (5.50) 
2a; 


Tuy có thể tìm Ô; từ hàm arcco$, nhưng vẫn nên tìm một giá trị S; 
và dùng hàm arctg 2 như thường l: 


Š =+Vq-Œ) 


Ta có: 
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Cặp nghiệm ứng với 2 dấu #+ tuỳ thuộc vào hình thể của robot lúc 


nâng vai lên hoặc hạ vat xuống. 


Để tìm S, và C; giải hệ phương trình (5.48) và (5.49). Hệ phương 


trình này có thể biến đổi thành: 


6, = arcig2(S.,C;) (5.51) 
(C;,C;—-S;S§,)a;+Cạ¿y =P, 
(S,C; +C;5;)a;+5¿a; = py 
(Ca: +a,)C; —S¿4:.5,=P, 
S;a,.C¿ +(C¿a; +a,)§, = mi V92) 
Khai triển và rút gọn lại thành hệ phương trình với 2 biến là S, và 


Giải hệ phương trình (5.52), ta có: 
_ (C;a; +a;)P, +Š;4:Py 
(C¿a; +a;)” +(¿a;)Ÿ 


2 (5.53) 


= (C;a; +a;)PyT—S;4:P, 
(C;ay +a,)” +(;a¿)Ÿ 


Do mẫu số của (5.53) và (5.54) đều dương và bằng nhau, nên: 


2 5.54 


Ô; = arctg 2 [(C:a;+a;) pự- S:a-p, , (Chay + 4;)p, + SapyÌ (555) 
Đến đây có thể xác định 6„: 
8,=Ô;„„-Ð- Ô; (5.56) 


Tiếp theo cho cân bằng các phần tử của 2 m¿ trận ở hàng I cột 3 


và hàng 2 cột 3 của phương trình (5.41): 


S = su (Cịa, + Siay) + S;¡¿3, (5.57) 
€; = S¡a, - C¡a, (5.58) 
Suy ra: 
Ô; = arctg 2 [C;;„(C¡a, + S¿a,) + S;ua„, Sa, - Cụa,Ì (5.59) 
Cuối cùng, để xác định 8, dùng phương trình: 
Ar'.*T, =*T, (5.60) 
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Trong đó ”T, là ma trận (4.29), còn ma trận vế trái được viết ở 
đang saU: 


f,(n f,@œ) 0 0 CÔ -§, 0 0 
f;(m f@) 0 0| |5, C€, 0 0 
f„ín) fq@) 1 0 0 0 10 c, 
w 0 0 1 0 001) 
Ký hiệu: 
sị =C;[C¿¿¿(C¡X + Suy) + S2 Z]— S;(S¡x — C/Y) 
35.62 
f; = —8,;„(C,X +S¡y) + C;;„Z bào 
Cho cân bằng các phần tử ma trận tương ứng, ta có: 
S, = —C,[Caa¿(C¡S, + Š8y) + S45; ]— Šs(Š15, =t#,) 5.63) 
C = —S;;,(CIs, + ð15y) + Cay¿$ (5.64) 
Vậy 
Ø, = aretg 2(S,,C,) (5.65) 


Các công thức (5.39), (5.55), (5.51), (5.56), (5.59) và (5.65) xác 
định tệp nghiệm của bài toán động học ngược của robot Elbow. 


5.3.4. Phương pháp "các nhóm 3" 


Theo phương pháp chưng, trình bày ở phần (5.3.1) ngay cả đối với 
trường hợp n =6 qua các ví dụ ở phần (5.3.2) và (5.3.3) khó khăn là ở chỗ 
làm sao xác định được phương trình nào trong hệ các phương trình đó 
mới tính được ra q, ở dạng công thức. 


Có thể nói chưa có thuật toán chung nào mà nhờ đó có thể tìm ra 
được têp nghiêm của bài toán động học ngược cho mọi robot. Phương 
pháp [38] giới thiện sau đây có thể xác định q, một cách dễ dàng và trực 
giác hơn, 

Nội dung của phương pháp “các nhóm 3” được giải nghĩa như sau: 

Như đã biết, vị trí một điểm trong không gian hoàn toàn được xác 
định trong hệ tọa độ 3 chiều, nên có thể phân cơ cấu robot ra những nhóm 
3. Nói chung viết thành: 3+3+3+ ....Tuy nhiên gốc toa độ của nhóm 3 kể 
từ nhóm thứ 2 trở đi đều cùng là đối tượng cần xác định. Đối với các loại 
robot dùng trong công nghiệp thường có ít hơn hoặc bằng 6 bậc tự đo, 
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nên việc phân nhóm 3+3 lại phù hợp với các thao tác trong thực tế, Thao 
tác đầu tiên là robot đưa bàn kẹp đến gản vị trí làm việc. Có thể gọi tên là 
thao tác "thô". Sau đó bàn kẹp được xê dịch nhỏ và xoay hướng cho phù 
hợp với công việc. Thao tác này gọi là thao tác “tình”. Vậy các nhóm 3+3 
tương ứng với các thao tác “thô”+"tinh”. 


Giải các bài toán động học ngược đối với trường hợp n =3, trở nên 
đơn giản hơn nhiều. Có thể dùng phương pháp hình giải tích thông thường 
hoạc dùng hệ các phương trình từ (5.7) với n =3 và lưu ý các vấn đẻ sau 
đây: 

Đối với nhóm 3 thực hiện thao tác "thô thì thường chỉ quan tâm 


đến vị trí, mà không quan tâm đến định hướng nên các thành phần của 
của các vectơ n, s. a đều bằng 0. 

Đối với nhóm 3 thực hiện thao tác “tinh” thì ngược lại, cho các 
thành phần của véctơ p bằng O. 

Nhược điểm của phương pháp này, như đã nói ở trên, gốc toạ độ 
của các nhóm 3, kể từ nhóm thứ 2 trở đi đều là những vị trí cần xác định 
hoặc cho trước. Thông thường người ta cho trước chúng như những điểm 
tựa công nghệ. 
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CHƯƠNG VỊ 
ĐÔNG HỌC ROBOT KHI DI CHUYỀN NHỎ 
6.1, GIỚI PHIẾU CHUNG 


tĩnh toán vẻ động học robot khi dí chuyển nhỏ sẽ nhận được những 
quấn hẹ vị phần, Chúng có tầm quan trọng nhất định trong HỘI số Irường 
hợp, ví dụ như Khí lắp ráp cầu v chính các giá trị chuyên dịch của các khúp 
để đáp ứnh yêu cầu có những thay đổi rất nhỏ về định vị và định hướng của 
hệ toa độ sắn liển với điểm tác động cuối của bàn kẹp robot. Hoặc Khi 
camera đụng quan sắt điểm tác động cuối của robot, cần vì chính về định Vị 
và định hướng để đạt được một mục đích nào đó, thì lúc này rất cần biết các 
quan hệ ví phần khí chuyển đổi qua lại giữa hệ tòa độ gắn liễn với caincra và 
hệ tòa đó săn liên với điểm tác động cuối. Các quan lẻ vị phân này còn 
đụng dễ tính toán độ chính xác cơ câu vẻ sự biển thiên của lực tác động lên 
các khâu và vẻ sự ổn dịnh tốc dộ dị chuyển v.v, 


6,3. QUAN HỆ DŨ CHUYỂN NHỎ ĐỐI VỚI HỆ TOA ĐỘ CÓ 
ĐINH. 


Cho ' Tà hệ toa độ ở khớp thứ ¡ nào dó của cơ cấu tay mấy, Khi có di 
chuyến nhỏ tì có: 


T+ đ[ <= Tuan§ (dx, dy. đz) Rot (d0). T (6.1) 


Trong đó: Trans (dx, dv, d2) - biểu thị các di chuyên nhỏ tịnh tiển đọc tiực 
dx, dv, đZ1rong hệ toa độ cố định. 


lót (K40) - biếu thị các độ quav nhỏ đÔ quanh trực vectr E 
trong hệ toa đó cố định. 


Có thể viết (6.1) thành: 


dTfz=A.T (6.3 
vớt ` Ä = Trang (dx. dự, đZ) làot (k0) - Í (6.3) 
Theo phép biển đổi nh tiến (xem mục 3.5.Í): 
JJ: 13-0: yfc1 
Trang (đ) = | MT DI - (6.4) 
L0 Ừ sz 
: Ú- 0g 0 lJ) 
d=dši+ d2j+ 4z (6.5) 
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Ỉ _ s*G ky =ksSu, ÂbE, xi6, -0Ị 
Rơi dc 0= |##y a+héếu - #ÿn+Ca nến, 0| t0) 
b ty, -kySn kyk;+iy6u KV +Cn ñ 
% 0 0 lÌ 
Lới với trường hợp dị chuyển nhỏ: 
lim sin đ —> 40) 
limcosØ — ị (0.7) 
lim verx0 — 0| 
Dã dùng các Ký liệu: Su = xinÐ, Cụ = c0NỔ, Vụ = vers0 
(Ver suniÖ = T - cos0) 
Vì vậy: 
[ ] ~Ä„0- kụdU h 
Ko Ác 0=: 1“... ni L6.Ä) 
=ÂylØ  kyd0 
0 0 0 h 
Thấy vào (6.3), bì có: 
1 090 dv][ 1 =&sM k 40 011 00 ù 
0 10 d,|] 4.40 1 —ÂRvẢ0 " | ú 0) 
".. NA 1, 0 1 0| 
l0 00 WÌ| 0 0 0 1ÌÌ0 00 1| 
w ~#+dg Kụdtg nã 
| k~dl0 0 =kyd8Ð dc 
Cn= T#ụdÐ d0 0á, Khpo 
| 0 ì 0 q 


Vận đụng phép quay quanh cie trục tòa độ (XeH! mục 
).1a nhận dược: 


trường hợp d7 chuyển nhỏ có các giói hạn tó.7 


3.1.2) đổi với 
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| Si hà 0j 


: : : | ờ~ | Kiểu Ọ 
leo (xố), Rot(WV, È,), No. ð,)= T : 


— ði Òy | 0 
lo 0o 0 1Ì 


với Õ=ðyvÌ+oij~ð-k (6.11) 


Sở xánh các pham từ của 3 mt trận (6,8) và (6 10), tạ có: 


k4õ = ở) 


Ñ,dồ =ồðy} l5: 
&.đõ = Ồ_ 
Thay (6.12) vào (6,9) tt có: 
|9 =ởz cởi dy 
xế _. : mi mã KŠ 
TÔ Ốy 0 đl„ | 
| 


[0 0 1 10] 
"h...x. 
HỆ nÉ" lối cả: 
LÔ 0 0 DỊ 


Khi có những đi chuyển nhỏ tình Hiến d và quay ði 
d=li+0.i-0Sk 
ö=01+0,/1.j+0.k 

hãy xác định độ dịch chuyển đT trong hệ toa độ cơ định 
(iu 


Theo các sẽ liệu trên ta thiết lập A theo (6,13): 


6.3. QU.VN HỆ DI CHUYỂN NHỎ GIỮA CÁC HỆ TOA ĐỘ 
VỚI NHẤU 

Phương trình (6.2) cho biết quan hệ dị chuyên nhỏ (quan hệ VỆ phần) 
đời với hệ toa độ cố định, Còn quan hệ đí chuyển nhỏ dối với hệ toa dò dà 
cho nào đó có thể biểu thị bằng phường trình vau: 


“1< TA t6.]-H) 
8ö sánh (6.2) và (6.4) ta có: 
Xe. : tô.FẤ) 
từ thÕ: 
GÁG 4L VÂN dƑ tó l6) 


Nếu biếu thị các phần tử cứa TỪ bằng các veetở H, xa nhữ văn thường 
xăm trước đây, tí có: 


Ƒ $ TỊ 
MẤY R) X dy Ủy 


với: 
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"n=n+n + nk 


S =S+sj+s,k (6.18) 


a~a + a j + a,K 


Thay vào (6.16) và sau vài phép biển đối tạ có: 


= 


Ụ -ða  ðs ð(pxn)+dun, 
h7 Bá ñ -_ŠÕn  ð(pxs)+1+ ds (808) 
-ðs Ôn Ụ ð(pxi)+ da | 
Ó 0 0 0 ] 
Mật Khác. FÁ có thế tính như sau: 
Ï § ~ Ỏ, “` ,¬ 
| là 0 cả Ta 
| T8 Tư Kì | (6.20) 
| 00 " 
No sánh các phần từ của 2 ma trận (€9) và (6.20). tí có: 
ị dị = ð{pxn)+dn = n.|(ðxp)+ di] 
| 
St B(pxs)+ d.s = s[(ðxp) + dị) (6 21) 
LẬP, =_ ð/(pxa)+dai= a|(ðxp) + dị ị 
ở =DÖn =nŠ 
Tố 
lo = ðs — sồ (6.23 


ờ,=ŠỒa cu) 
Cúc phường trình (6.21) và (6.22) biểu thị các thành phần của 2 veetở 
chuyển địch nhỏ tính tiến và quay Cđ và TỔ) đối với hệ tọa độ T, 
Trên cơ sử dó ta có thể thiết lấp quan hệ giữa các dĩ chúven nhỏ siũa 


các hệ tọa dộ với nhấn bằng mái trận 6x6 sau đây: 


140 


[ lộn TÌP = 
L7 ứ| Ủy Nhy H, (pxn).. WpSHiu (pxh)_ "5 
Đi 6â "= (DXS). (DXS), (pxS)„ lử 
: Tin là đc Đo đỐ (px HỘ XS), (XS). lộ _ 
để đc l0  Ợ: 2Ð H H 1 “sa 
1 Sy | 3 s ÀW 
Lm vị : 
| Si | 00 0 s. nà : ở, 
ly 0.0 0 D a a ỜS 
H > 4 ` Rh &, Lạ 5e 5| 


Ví du 2. Cho hệ toa độ T và các di chuyển nhỏ d và Ö như trone Ví 


dụ 1, Hãy xác dịnh độ địch chuyển tượng dường Tg và TỔ trong hệ toa đó TT. 


GH: 
Biểu thị các phần tử của mã trận Ê theo dạng (6.17): 
li =: 
Hy 1y úy Dự 
""=  ^.. Ị 
==- | 
“-... `... 


k6. - 6 -:0 LỊ 
trone dó: 
n=0.i+1.j+0.K 
S§=0.1+0.j+1.K 
ñ=l.i+0.j+0.k 
p=l0.i+5.i+0.k 


Vậy: 
¬ ` ằẰ.. 
ðxp=l0 01 0|=0i+0.j—1.k 
Lữ “5: <0 
và ðxp+d=l.i+0j -0.3.k 


Thay vào (6.21), tạ có: 
*a=7d,i + 7á j + fd,k=0.i- 0.57 + 1k 
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Lỗ = T8 í + "ä j + 'd, =0/1.- 0 +0,k 
Có thế Kiểm tra lại công thức (6.14): 
q1]. 
Trước hết vác định TA theo /d và *Š theo (6.20): 
¡09 0 Ú -Ï 
| 0 0 -01 -05{ 
Ị 


LA 

01 =6 Ị 

Ễ 00 0 | 

Vậy: 
[8- 6, 1: ƠI !0 0; 0 j2 
l@4' ;0:.'ä Ệ 0 0| 
dÀ = CÀ Sới 

| ] ỘÔ 0) lồ. z#-. si} =ðI 
|0 0 0 1] c0 00 0) 


644, TACOBLAN ĐỐI VỚI CƠ CẤU TAY MÁY 


Nết trường hợp phố biến cơ cầu 1aV mấy có 6 bậy nể do, Sự thay dõi 
nho vẻ định ví và định hướng của T, được gây nén bởi các dd, của các khớp 
độmu, 


Thco (6.14) ta viết: 
ĐT 58T Y Ấy k0, Sa đyáJÐã) 5 Ä2/X sua cựu. s01) 
SHV FA 
ĐT. 


SG rên 6, nh 6.25 
ÔW, GP) 


Với các viết ký liệu thường dùng như (4.7) + (4.9) thì: 


mẽ... nh. 


_“=“. ` `———”ˆ 
(ứr_ nÌ 
Wế ” địa IR 
=1 _ jÌ Ø0 m—I 
Vậy Tụ _= T1 ¡ Tr, 
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Từ (6.34) tạ xác định '^A: 


74 "¬. = 
'Â, Sên JÀ Ẻ là xã (36) 


là 
j—] “.. _ 
với là = TỆ JÏ sí _." (22) 


Đi với Khóp quay: 


d Ô, Ỗ 0 0 


[0 =zØ 0 0] 
0 JNH. ) 


Ù @.ố: (Ú | 
th TỦ 707 s6Ð l 
VN ca | 
00 90 dd; 
lút ốc tổ - l8) | 
Tá thường biểu điển (xem mục 4.2) mà trận T dưới đạng sau: 

n;, s, a, Pp.| 

HTỢ Êh số Đi (6.28) 
0 0 0 bị) 


Vậv nếu khớp ¡ là khớp quay thì d, = Ô và từ (6.21): (6,22) ta có: 


_ =. n,(Š; »Ð; | 
THẬP, E2 s,(Š, xD,) (6.30) 
THỦ a,(ð, xp,)| 
Tẩy c= SUỖ, (6.30) 
“ấn, seo lA:Ô, 

là, 


Đồng thời Ô, = 0Ï + 0.j + 1. k nên (6.29) và (6.30) còn đơn giản hơn 
nữa: 
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` 


¿h 4 
/ = —=ú, 1, + H, suối 
: j¡yỉ y tỤ lở IY | 


16 = ai XhỔ 3%, H s : { 1= | 
đụ “hit Hào Thủy V cửu 
lá Am 
1N lày Bộ “uy 
l6 đxc cố =| 
1Á làm 
“HN — và t (6.32) 
 =.-. _| 
- Z 
Còn đối với trường hợp khớp tịnh tiến ð = 0 và đ = 01+ 0.j +0. 
thì 
“4= n.Í+s„j>+a,k (6.33) 
8 =0ii+0.j+0.k (6.34) 


Như vậy sự thay đổi nhỏ vẻ định vị và định hướng của Tị phụ thuộc 
vào 6 tơa độ khốp động và có thể mô tả bằng ma trận Ốxố, được sọi là 
Jacobian của cơ cấu tay mấy sau đây: 


[ AI Ki 76 dÁ,. là đ, ` Ti Tp, To “A| I§ du, | 

16 L r6, / 1ó đ,, T6 đy, H) đy, _ 16 “nh đụ, 

tờ 7o di T6 đ 76 đ. T6 d,. 70 dị. it đụ 

Tại D mg : Tà, 7b Ổ,, r6 Ổy, rủ Ổy 16 Ồ,, lá? %ÌL 6.35) 
/6 ÿ 6 Ổ,, 16 Ổi, 76 Ổ, 1T ổ, 76 Ổ, T6 ì : dự 
l: tô ổi, 76 ổ,, Tó ` rCS : 76 ổ, 76 ổ, dạ, | 


Trong đó các phần tử ở môi cột của Jacobian tương ứng các vì phản 
độ di chuvển tịnh tiến và quay của mỗi khớp dòng. 

6.5. TRÌNH TỰ GIẢI BÀI TOÁN THUẬN KHI ĐI CHUYÊN 
NHOÒ 

Bài toán được đặt ra như sau: Cho biết trạng thái của T, (biết định vị 
và định hướng của điểm tác động cuối, tức là cũng biết các phần tử của mã 
trận T,), cần xác định độ đi chuyển nhỏ đT, khi trước sự thay đốt dụ, của các 
Khới? quay, 


Trinh tự giải: 
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Khi đã biết đq,, theo phương trình (6.35) sẽ xác định: 
1q = 4+ ^d,j+ °d,k (6.36) 
"ð="“§i+ “j +hố,kKE (6.37) 
Trên cơ sở (6.36), (6.32) và dùng (6.20) để xúc dịnh “A, rồi suu đó 
tính fT, = Tị ”A. 


Muốn vậy, trước hết phải xác định các phần tử trong từng cột của 
Jacobian ở phương trình (6.35). Các phần tử ở mỗi cột tương ứng với các vi 
phân độ di chuyển tịnh tiến và quay của môi khớp động. 


Khi giải các bài toán động học La đã đừng các phương trình quan hệ 


^nu: 
iu n5 (UP (6.38) 
ø Ấn. ức (6.39) 
DI) CN), RỦ NGA v/Ai (6.40) 
5l Sát Ti Đo SE, dnï (6.41) 
v9 o1, sá: TT, (6.42) 
ĐT, 


Các cột tương ứng với các thành phần của theo (6.25) với 
ê, 

¡= [,... 6 tính từ cột 1 đến cột 6 và tương ứng sử dụng lần lượt Tạ: "T,: ”E,: 

TT; 7T, và ŸT, theo (6.28), (6.38 + 6.42). Khi đó biết nạ, s, à, và p, từ các ma 

trần này tí sẽ tính các phần tử các cột của Jacobian theo các công thức 

(6.31) và (6.32). 


Dưới dây là ví dụ mình họa phương pháp nói trên đôi với trường hợp 
Robot Stanford. Trong Robot Stanford các ma trận A, đã được xác dịnh bằng 
(1.20). còn các ma trận "T, đã được tính toán bằng các biểu thức từ (4.21) 
đến (4.27). 


ổT 
_ ,, ~Ã ` Ẫ 2 Z9 = s » Ũ © mài 
Cót thứ nhất cua Jacobian tượng ứng với các thành phần của ——— với 
th 


T„. như đã biết, có thể biểu diễn như sau: 
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T,= H. Ẩ. a D. (6.413) 


Các phần tử trong ma trận 1 đã được xác định bằng các biếu thức 
trone (-|.27). 


Trên cơ sở các phương trình (6.31) và (5.32) ta tính các phản tử của 
cột thứ nhất như sau: 
“du =-ÍŒ, ÍC; (CC, - S¿S¿) - 58,C¿[ - S. (SUC:C, + C0] 
x i5, 5đ + Cd,} 
+ISIC, (C,CẢ - 352) - S,5Œ,} + C,(S,CŒ + CS 2] 
x 1C,5;d: - S.đ,] (6.11 
14, = ={C, [- C(C,C¿S,+ 5C) + S,SS„) 
-¡ (- S,C:5S, + C,C,)]} 
x (5,5;d; + Œ¡d;]} 
+ 1S,Í- €; (C,C:%, + S,Œ) + S5: 
+C€,(- S,C€:S,+€Œ,€,) | 


x C4; - S,đ:} (6.43) 
4q. =- C(;€,S; + SC,) - S/5/S2) (8,S5đ; + Có} 
+ bỏ (CS + S:C;) + C8521 ÍC,S:d, - S.d.{ (6.-161 
"=8; (CCŒ,- 8 8)= SG (6.47 
s < =8; (CC/S, + SŒ/) + C.S:S, (6.-1Ñ¡ 
15, =- SCjS; + CC, (6.-19) 
Rút eọn l1, tà 
—@;[C5 (CC, — S,%)—88€ ]+S40SCC, CS ) | 
—th|=€; (CS, . s39 ]+X4 5# @S,C SA, +C CC) 
„SG, Sử C sCẠC (9y) 1/7 uốc 
CÓ: —= v PS VY 6.M)) 
tứ —8,(CQ€Ó, —S%)~CSS;C, 
(CC +6 CS )+C 2S 
#5š\C 0 TP E6 | 
- ` ; 1. "` 
Cói #hứ Í ø 2 của Jacobian tường ứng với các thành phần cửa ——", 
œGqa 


tính theo công thức 6.25) với 'T,„ đã xác định bằng (4.25) và tương tự như dã 
lầm ở trên ta cổ: 
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- {C(C/C:C, - S¿54) - S5:C¿} {- Cd,} 


_N mi 

+†S.(C,€/Œ, - S,S,) + €,S.C,} 1S;d.} (6.51) 
hd, =« 1< CC, + S,C¿) + 8.8%) {- da] 

+ {-S,(C,€;Œ, + S,C,) - C;S;S,] {5d (0:52) 
^q = - {C;C¿8; + S,C/){- C,d,} 

+ {S,C,S, - C;C;)1S;d} (6.53) 
TÔỂNG ÁN SP Ác là Tưng 
l3, = - 8C, + C,C, (6.55) 
"n (6.56) 


Sau KỈ rút sọn, ta có: 
(ý 1Ê CC Số ) ' 
Ä đ; (C,Ó;€, Bộ 5€) 


ỐT, —- đa CS: 
ô, ' Xã G đ ng đi, (6.57) 
HS ï 6 VÌ ỦU SỈ 
"Y | 
Cột thứ ¡ = 3 của lJacobian tương ứng với các thành phần của = 


tính theo công thức (25) với ”T, đã được xác định bằng (4.23) và Lương tự 
thư đã làm ở lrên ta có: 


= ` LAN 
SỐ 
Øi 2 ||| vế 
ôj, | 9Ô VIn) 
0 
0 
_ BÀ về 5 có Am... ". 
Cột thứ ¡ = 4 của Jacobiiui tượng ứng với các thành phần cửa Em : 
dì 


tính theo công thức (6.25) với  T, đã được xác định bằng (4.23) và tương tự 
nhữ đã làm ở trên Ta có: 
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0 
ð1, — 0 
Ôa, - tá, (6.39) 
TỐ, 
@ 


Tương tự, đốt với trường hợp cột thứ ¡ = §, với ”F, theo công thức 
(4.22) tr có: 


0 
0 
ệT, |0 
ñy. li) (6.60) 
Œ, 
0 


Cuối cùng, đối với trường hợp cột thứ ¡ = 6, với TT, theo công thức 
(44.21) có: 


0 
0 
ô7, |9 
ôq, l0 (6.61) 
0 
1 
Ví chị Ÿ: 
làobot Sumford đang ở trạng thái cấu hình sau: 
0 1 0 20 
nh ¬ x..ẽ 
°=Íp g _1  g |tưƠng ứng, các toa độ có các giá IỊ sau: 
0 0 0 ] 


q,=0”, qy= 90” d: =2mm q¿ = 0, q; = ĐÓ”, qy = 90” còn đ. = 6n m, Hãy xác 


148 


định mã trận Jacobtan và tính toán giá trị độ dị chuyên nhỏ đT, của bàn kẹp 
hị các khốp có độ đi địch như sau: 


®1 | 


Giải: 
Xúc định phần tử của các cột của Jacobian theo các công thức (6.60) 
và từ (6.57) đến (6,6 L}: 

200 00 00 00 00 00| 

60 00 10 00 00 00 

ếT, 00 200 00 00 00 00 | 

ôg |0 10 00 00 10 00| 

00 00 00 10 00 00 


10 00 00 00 00 10 


Vị trí và hướng của bàn kẹp đã được vì chính như sau: 


71V. |: | 20/0" -00: (0° 08 00 đi 0á] 
| 1.4 =60 06 L0 0.0 00 00l1—-0.1 
|-30| | 09 200 00 00 00 00 | 20. 
|00 | |00 10 00 00 10 009Í 0| 
Ï 
| 0. 00 00 00 10 0/0 001) 041 
|00 | [cL0 00 00 00 00 1011 01] 


Như Vậy: 
"J = 2/0i + 1.4J— 2.0 
^$ = 0,01 + 0.11 + 00K 


Theo công thức (6.20). ta có 


1490 


l6 


Và nhân T,, với '^A. ti có: 


I1 0 0 60 00 0 14 | 
đT,- | 
§:-3- saƒ: - 3ÿ _¬ Mô 6... 
Ú 0 17,9 9 9 0 ] 

[L0 0 0 HÌ 

0 0 01 20 

đaS | ly: 3ô: - ;8 Ti 


j“ 0| 
6.6. Jacobian nghịch đảo 


Phương trình (6.35) có thể viết son lại đưới đang đa trần sau: 
" t^ % x c ` 


D=1.QO (6.02) 
tronp D và Q là 2 mã trận Ì cót: 

(hại L chữ, 
&- ho, đhựa 
: | đợi: 
0)S1I000 „|5 Q= | đự, 
bã Ỗ, dự: 

L ` đt, L4 _ 


côn Jaeobtam } lá mà trận 6X6 đã được mô tí 'rong (6.38). 
liài toán ở đây đặt ra như sau: 
Cho biết sự thay đối nhỏ về địnE vì và định hướng của T, biểu thị 


bản má trận Ð, Cần xác định bộ giá trị dd, ở các Khóp dòng, 
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Lời giải có thế xác định từ phương trình (6.62): 
Q=J'D (6.63) 
Tuy nhiền việc tìm lời giải này nhiều khí rất phức tập, do bản tư 
tính phức tạp cúi các phần tự Tacobian và do chứa đựng nhiền phép tính dị 
xá và lượng giác đá THỊ V.V, 
Ngoài ra, còn có phương pháp xác định dự, trên cơ sở liV vì pm các 
loi giải tường ứng của bài toán động học ngược robot, 
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CHƯƠNG VII 


LẬP TRÌNH QUỸ ĐẠO CHUYỂN ĐỘNG VÀ MÔ 
PHỎNG CÁC HOẠT ĐỘNG CỦA ROBOT. 


7.1. GIỚI THIỆU CHUNG VỀ LẬP TRÌNH CHO ROBOT 


Khi xem xét vấn đề lập trình cho robot. không những cần quan 
tâm đến các chuyển động của bản thân robot mà còn phải lưu ý đến sự 
hoạt động của cả hệ thống sản xuất, mà robot là một thành viên. 


Hệ thống sản xuất gồm nhiều đơn nguyên hoặc môđun thiết bị sản 
xuất (workcell). Đó là một cụm các thiết bị, bao gồm một hoặc một vài 
robot, máy công tác hoặc băng chuyền, các cơ cấu cấp thoát phôi hoặc đồ 
gá phụ trợ khác v.v... Thông thường để lập trình điều khiển robot trước 
hết phải mô phỏng sự hoạt động của nó trong một "“ workcell" cụ thể. 


Có thể phân tách thành 2 phương pháp lập trình: lập trình trực 
tuyến (on - line programming) và lập trình ngoại tuyến ( off - line 
programming). 


Khi lập rrình trực tuyến, người vận hành robot trực tiếp tiến hành 
lập trình trên bản thân robot hoặc thiết bị phụ trợ kèm theo. Có phương 
pháp lập trình thủ công (manual input), phương pháp lập trình theo kiểu 
dạy học bảng cách dẫn dắt (teach by lead through) và phương pháp lập 
trình theo kiểu dạy học bằng thiết bị dạy học gọi là "teach pendant". 


Lập trình thủ công là phương pháp đơn giản nhất và thích hợp 
nhất với các loạt robot không được trang bị thiết bị trợ động ( non - servo 
- controlled robots), không có tín hiệu phản hồi. Để lập phương trình có 
thể dùng các cữ tỳ, cơ cấu cam, bảng ổ cắm điện. các công tắc hành trình 
v.v... Các loại này tuy đơn giản nhưng lại có nhiều ứng dụng. Thực tiền 
sản xuất đã chứng tỏ rằng có thể chế tạo ra những chương trình thao tác 
không đơn giản bằng cách thức đơn giản đó. 


Phương pháp dân dất để "dạy học” cho robot có thể thực hiện 
được những công việc tỉnh tế hơn. Người vận hành dẫn đất robot làm các 
thao tác theo yêu cầu và ở những vị trí cần thiết, các tín hiệu được nhận 
biết từ các cảm biến (sensor) lắp trên robot sẽ được ghi lại. Khi làm việc, 


các thông tin tín hiệu đã ghi nhớ này sẽ tác động vào cơ cấu chấp hành 
làm cho robot hoàn toàn lập lại một cách tự động các thao tác đã "học” 
được. 


Có thể "dạy học” cho robot theo phương pháp dùng hộp điều 
khiển "teach penđant". Đó là một hộp nhỏ cầm tay có các nút bấm điều 
khiển. Khi bấm các nút điều khiển này, các khớp động của robot chuyển 
địch một đại lượng nào đó theo ý người điều khiển và các giá trị đó được 
ghỉ lại để lập trình khi chuyển sang chế độ tự động. 


Trên hình 7.1 biểu thị các phương pháp lập trình kể trên như các 
bước phát triển hiện đại dần. Lập trình ngoại tuyến là một bước phát triển 
cao hơn về chất. 


Lập trình ngoại Imyến (of - line progpramming) không tiến hành 
trực tiếp trên thiết bị robot, mà tiến hành gián tiếp trên máy tính. Đè thực 
hiện được việc trao đổi thông tin giữa người và robot phải dùng đến ngón 
ngữ mà cả hai đều hiểu được. Các ngôn ngữ chương trình là ngôn ngữ 
tường minh (explicit languages) cho phép người lập trình truyền tín hiệu 


cho máy công tác thực hiện các thao tác cần thiết. 
Ngôn ngữ lập trình 
theo nhiệm vụ 


Ngón ngữ 
phát triển 


Lập trình ngoại 
tuyến 


Dạy học bằng hộp 
điều khiển 


Dạy hợc bàng cách 
dẫn đắt 


L 


Hình 7.1. Sự phát triển các phương pháp uà ngôn ngữ lập trình 


Lập trình trực 
tuyến 


Máy tính là một thiết bị vạn năng, tổ hợp các lệnh để máy hoàn 
thành các công việc rất đa dạng. Ngôn ngữ máy cho phép dÈng các ngôn 
ngữ bậc cao, gọi là ngôn ngữ phát triển. Trong tin học có nhiều loại ngôn 
ngữ. Tuy nhiên trong điều khiển nói chung và điều khiển robot nói riêng 
cần quan tâm tới sự tiện lợi và nhanh chóng để đảm bảo thời gian thực. Vì 
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thế xuất hiện nhiều loại ngồn ngữ chuyên dụng, định hướng chơ một loại 
vấn đề nào đó. 

Như vậy khí lập trình ngoại tuyến đều cần dùng đến ngòn ngữ lập 
trình. Mức thông thường dùng các ngôn ngữ tường minh (explicit 
language). Mức cao hơn là dùng ngôn ngữ không tường minh (implicit 
language).Đó là mức dùng ngôn ngữ lập trình theo nhiệm vụ (task - level 
programming language). Những ngôn ngữ này cho phép người sử dung ra 
lệnh để robot thực hiện các công việc mong muốn một cách trực tiếp mà 
không cần chị ra chỉ tiết các hoạt động của robot như các ngôn ngữ lập 
trình thòng thường. Như sơ đồ trên hình 7.1, đây là mức thứ 3 của phương 
thức lập trình ngoạt tuyến. Ví dụ, ngôn ngữ AML của hãng IBM, Karel 
của hãng General Motor, Fanuc, Rail của tập đoàn Automatix, Jars của 
NASA và RPL của SRI International. Các ngôn ngữ này còn đang ở giai 
đoạn phát triển. 


Ở phạm vị ứng dụng ngôn ngữ tường mình cũng có 2 mức: 
~ Ngôn ngữ robot chuyên dụng. 


Những ngôn ngữ lập trình này được xây dựng như một ngôn ngữ 
mới. Cú pháp (syntax) và ngữ nghĩa (sematics) của các ngôn ngữ này cần 
phải rất đơn giản vì người lập trình cho các ứng dụng công nghiệp không 
phải là chuyên gia về lập trình. Ví dụ, ngôn ngữ VAU 2 của Unimation, 
AL của Đại học Standford. : 


- Ngôn ngữ phát triển. 


Ngôn ngữ này tạo ra các thư viện robot cho một ngôn ngữ lập 
trình bậc cao đã có sẵn. Những ngôn ngữ lập trình robot này được xây 
đựng bằng cách dựa trên các ngón ngữ lập trình bậc cao thông dụng (ví 
dụ như Pascal) và thêm vào một thư viện các thủ tục về hàm đặc biệt 
dùng cho robot. Khi viết chương trình Pascal để điều khiển robot, người 
sử dụng gọi các hàm hoặc các thủ tục đã định nghĩa trước trong thư viện 
để xử lý các nội dung có liên quan đến việc tính toán hoặc điều khiển 
robot. 


Ví dụ. PASRO (Pascal for robot) là một thư viện dùng cho lập trình 
._ hot, cung cấp nhiều thủ tục và hàm đặc biệt để tính toán và điều khiển 
- bot đùng trong môi trường ngôn ngữ Turbo Pascal, hoặc PASRO/C là 
phát triển của PASRO, nhưng được viết trên cơ sở ngôn ngữ Turbo C. 


7.2. MÔ TẢ CÁC VẬT THỂ VÀ NHIỆM VỤ. 
7.2.!. Mô tả các vật thể 


Các vật thể gọi là các 
đối tác của robot trong công 
việc và các thiết bị và đồ vật 
trong môi trường làm việc. 
Chúng rất đa dạng và phong 
phú. Tuy nhiên có thể dựa vào 
các khốt hình cơ bản sau đây để 
mô tả chúng: 

- Khối hình vật thể tròn 
Xoay (rotatIve). 


- Khối hình vật thể làng 
trụ (prismatic). 


Các vật thể có cấu trúc 
hỗn hợp (combination) có thể 
mô tả bằng cách ghép nối các 
khối hình cơ bản. § 

Khối hình vật thể xoay 
tròn được đặc trưng bằng toa độ 
tâm và bán kính của hình tròn 
các tiết diện. Ví dụ, trên hình 


Hình 7.2. Mô tả chỉ tiết hình trụ 


-1,4.0 
7.2 mô tả một chi tế máyhình || -*---` ^ 
trụ bán kính r = 0,5, chiều dài “ y 
Ì =6; nằm đọc theo trục z. L00 L40 
X 5 " 3 : 
Khối hình vật thể. đa diện, Hình 7.3. Mô tả uật thể hình ˆ 


được đặc trưng bằng toạ. độ các đa diện. 
điểm Øðốc cạnh của nó. 
Khi mỏ tả các vật thể trong môi trường làm việc, cũng như khi mô 


tả quá trình thao tác của robot và dịch chuyển các đối tác, có thể dùng các 
phép biến đổi thuần nhất. 


Xét ví dụ sau đây: 


Cho một vật thể hình đa diện trong hệ toạ độ cơ sở xyz như hình 
7.3. Có thể lập một ma trận mà mỗi cột là véctơ mở rộng biểu thị môt 
điểm góc của tam trụ. Cụ thể đối với hình 7.3 có 6 điểm góc, fa có: 


“1535 


E —1 -—1 1 1 -Ì] 
0 0 0 909 4 4 
"_Jo 0 2 2 009 ŒD 
| ] 1 I 1 1 
Thực hiện phép biến đổi: 
H =T,(4.0/0). R(y. 90). R(x, 909) (12) 


sẽ lần lượt nhận được các kết quả sau: 

- Tịnh tiến vật thể dọc theo trục x một đoạn bằng 4 đơn vị tương 
ứng với phép biến đổi H, = T, (4,0,0),hình 7.4. 

- Rồi cho vật thể quay quanh trục y góc 90” và kết quả của hai 
phép biến đổi trên H; = T, (4,0,0). R(y,90),hình 7.35. 

- Tiếp tục quay vật thể quanh trục z góc 90” và kết quả của phép 
biến đổi H theo (7.2),hình 7.6. 


Hình 7.4, Vật thể sau phép biến đổi H; = T,(4,.0,0) 
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Hình 7.5. Vật thể sau các phép biến đối H; = T, (4.0.0). R(y,90") 


z 
Ạ 


Hình 7.6. Vật thể sau các phép biến đổi H= T„ (4,0,0). R(y,90). R(x,90) 
Ma trận H theo biểu thức (7:2) có thể xác định bằng tích các ma 
trận quen biết đối với các phép biến đổi cơ bản nói trê§& ta có: 


0 0 1 4 
0 0 
w\ (7.3) 
0 0 


© CC 
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Như vậy dễ đàng xác định ma trận V' biểu thị vật thể sau các 
phép biến đổi (7.2) 


4 4 6 6 4 4 
h /Si lý S> J: nh 
V=ẴH.VY=lọo 0 0 0 4 4 Œ.4) 
I1 I1 I I1 
® @ 6 @6G6 


7.2.2. Mô tả nhiệm vụ. 


Nhiệm vụ giao cho robot thực hiện thường được mô tả bằng các 
thao tác chuyển dịch. Có thể tìm hiểu nội dung này thông qua một ví dụ 
cụ thể. [12] như trình bày trên hình vẽ 7.7. Ở đây robot lấy trên băng 
chuyền các chiếc chốt hình trụ đã được mô tả trên hình 2.2, để lắp vào 
các lỗ trong thân máy hình hộp. 


Hình 7.7. Mô tả nhiệm uụ 
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Nhiệm vụ nói trên có thể mô tả bằng một dãy liên tiếp các vị trí 
thao tác sau đây: 


P: 
P:: 


P‹: 


Hướng tới chốt 

Kẹp vào chốt 

Kẹp chặt chốt 

Nâng cao chốt 

Hướng tới lồ với các góc nghiêng nào đó 
Dừng lại khi chạm vào lỗ 

Điều chỉnh lại hướng góc nghiêng 

Lắp chặt vào lỗ 

Nhà chốt ra 

Rời đi. 


Dùng phương pháp toán đồ chuyển đổi (xem phần 4.5 chương IV) 
để mô tả nhiệm vụ tại các vị trí thao tác nói trên, như trình bày trên 


hình 7.8. 


E,P4 


Z&_ TỔ EPG ĐỌ P 


Z  .T  EPG PHA HRi H 


VỆ T14 EPG PCH HRi 


Hình 7.8. Toán đồ chuyến đổi mô tả nhiệm uụ tại cúc uị trí 
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Tương ứng: 


p: ZTLE=PPA (735) 
p› ZTE =PPG (7.6) 
p: ZTE=PPD PG (7) 
p:  ZT,E = H HRiIPHA PG (78) 
p:  ZT,E = H HRi PCH PG (7.9) 
Đ«: ZTỤ,E = H HR¡i PAL PG (Œ.10) 
p - ZTUE= HHRiPN PG 10) 
p 7TE~>HHRiPN PA 7.12) 


Trong đó ở mỗi vị trí thao tác được mô tả bảng ZTL,E 
(xem hình 4,I 1) với: : 
Z.- Mô tả vị trí trạng thái của robot trong hệ toạ độ gốc nào đó. 
Tự - Mô tả vị trí trạng thái của điểm cuối của cánh tay robot trong 
hệ toạ độ cố định gắn với giá đỡ của robot. 


E - Mô tả vị trí trạng thái điểm cuối của công cụ kèm theo. 


Nói đến vị trí trạng thái là nói đến vị trí và hướng của hệ toạ độ 
gắn với vị trí đang khảo sát. Với cách mô tả đó, khi mô tâ vị trí robot thì 
chỉ cần thay đổi Z và khi thay đổi dụng cụ thao tác thì chỉ cần thay đổi E. 


Để mô tả cấu trúc về nhiệm vụ, ở đây cũng dùng các phép biến 
đổi tương ứng sau đây: 


P.- Mô tả vị trí trạng thái của chiếc chốt trong hệ toạ độ gốc. 

PA - Mô tả vị trí trạng thái của bàn kẹp đang hướng tới chốt. 

PG - Mô tả vị trí trạng thái của bàn kẹp đang kẹp chốt so với chốt. 
PD - Mô tả vị trí trạng thái của bàn kẹp bắt đầu mang chốt ởi. 

H Mô tả vị trí trạng thái của hộp thân máy có hai lõ, 


tIRi- Mô tả vị trí trạng thái của lỗ thứ ¡ trong hộp thân máy so với 
l hệ toa độ H. 


PHA - Mô tả vị trí trạng thái của chốt đang hướng tới lỗ thứ ¡. 
-_PCH - Mô tả vị trí trạng thái của chốt khi chạm vào lễ. 

PAL - Mô tả vị trí trạng thái lúc bắt đầu được lắp vào lô. 

PN - Mô tả vị trí trạng thái của chốt khi đã lắp vào lỗ. 


Việc thực hiện các nhiệm vụ trên có thể trở nên phức tạp hơn nếu 
trong đó ngoài những bước đi xác định, ví dụ như HRi hoàn toàn có thể 
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xác định từ bản vẽ kỹ thuật, còn có các bước đi khác cần thông tin để 
hiệu chính. Trong trường hợp này thường sử dụng kết hợp với các biện 
pháp khác. ví dụ. phương pháp dạy học cho robot. 


Trên hình 7.9 trình bày 3 hệ toạ độ Z, P và H gắn liền tương ứng 
với robot, chiếc chốt và thân hộp có hai lô . 


Hình 7.9. Cóc hệ tọa độ Z, P sà H 


Thiết lập quan hệ của các hệ toạ độ Z„ P và H với nhau và với các 
hệ toa độ gốc. Ví dụ, trong hệ toạ độ gốc nếu chọn gốc của hệ ‹Z. ở toạ độ 
x=-30,  y=0,z= 50 như trên hình 7.9, ta có: 


1 0 0 -30 
0 I1 0 0 
J= 
0 0 I 590 (7.13) 
0 00 0 


Trên hình 7.10 có 2 hệ toa độ: T, gắn với điểm cuối của cánh tay 
robot và E gắn với tâm của bàn kep. Điểm gốc của hệ E nằm ở vị trí 
(0,0,10) trong hệ toa độ T,. Do vậy, 1a có: 
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l0 0 0 

: 0 10 

tàn 
0 0 1 10 Œ.19 
0 00 1 


Hình 7.10. Cóc hệ tọa độ T; uà E 


Trên hình 7.11 trình bày cách bố trí các hệ toạ độ: H gắn với hộp 
thân máy. HR, gắn với các lỗ. Theo đó, ta có: 


| 0 I0| Ị 0 0 ni 

0 Ệ 20! „ l0 L0 

li: -1 0 15 ` lô: ¬ : 0.15) 
0 0 0] 0 0 0 1 
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X 
HR[I| HR [2] 


` 


-Ệt rên + 


Hình 7.11. Hộp thân máu 0à các hệ tọa độ 


Hình 7.12 mô tả vị trí trạng thái khi chốt đã lấp vào lỗ. Khi đó 
trục Z, của chôt phải trùng với đường trục của lô. Vì chốt có hình trụ tròn 
đối xứng nên phương của các trục x và y có thể tuỳ ý. Chọn phương trục x 
thẳng đứng. tức là giữ ngyên như phương thắng đứng lúc chốt từ vị trí 
nằm ở băng tải vừa được nâng lên. Vậy vị trí trạng thái của chốt khi đã 
lắp vào lễ có độ sâu là 4 được mô tả bởi ma trận chuyển đổi sau so với 
HR: 


0 
0 = 
1 (7.16) 
0 


=. 
®œ CC = C 
— + CC ĐC 


Hình 7.13 
mò tả VỊ trí bàn kẹp 
trên chiếc chốt, cồn 
ma trận chuyển đổi 
sau đây mô tả vị trí 
trạng thái của bàn 
kẹp chốt so với 
chốt: 


Hình 7.12. Chốt lắp uào lỗ. 


trên. 


tóá 


7 0 -7 9 
0 I! 0 0 
7 0 -7 -5Š5 
0 0 0 1 


Hình 7.13. Chối lắp uảo lỗ 


Tiếp theo xác định các ma trận chuyến đổi khác 1: ác quan hệ 
cấu trúc ở các vị trí thao tác khác nhau của robot như đã được mô tả ở 


` 


Ứng với vị trí p, (7.5) tức là lúc bàn kẹp hướng tới chốt: 


ZT,E=PPA 
Từ đó: 
PA =P'ZT,E 
Ứng với vị trí p, (7.6) tức là lúc bàn kẹp kẹp chặt chốt: 
ZT,E=PPG 
Từ đó: 
P =ZT,EPG' 


Ứng với vị trí p, (7.7) tức là lúc nâng cao chốt: 
⁄T,E= P PD PG 

Từ đó: 

PD=P'ZT,EPG' 

Ứng với vị trí p„ (7.8), tức là lúc hướng tới lỗ: 
ZT,„E= Hì1R, PHA PG 

Từ đó: 
PHA =(HHR>y'ZT,EPG' 


Ứng với vị trí p; (7.9), tức la lúc đừng lại khi chạtn vào lỗ: 


(7.18) 


(7.19) 


(7.20) 


Œ.2 


ZT,E = H HR, PCH PG 
Từ đó: 
PCH = (H HR,)“ ZT,E PG ' (7.22) 
Úng với vị trí p„ (7.L0), tức là lúc điều chỉnh hướng góc nghiêng 
ZT,E=H HR PAL PG 
Từ đó: - 
PAL =(H HR,}' ZT,E PG' (7.23) 
Hình 6.14 minh hoa các vị trí thao tác p„, p‹. và P, 
Ống với vị trí p;..(7.1 1). tức là lúc lắp chốt vào lỗ: 
ZT,E= HHR, PN PG 
Từ đó: 
H=ZT,E (HR, PN PG)' (7.24) 


Hình 7.14. Các uị trí thao tác pạ, p;, 0à pạ. 


7.3. HỆ THỐNG ROBOT LÀM VIỆC VỚI CAMERA. 
7.3.1 Biến đổi chiếu hình. 


Biến đổi chiếu hình là phép biến đối quang học để chiếu-các điểm 
trong không gian 3 chiều lên một mặt phẳng. Phép biến đổi này rất cần 


165 


thiết khi trao đổi thông In giữa các vật thể 3 chiêu và hình chiếu của nó 
trên các mặt phẳng. 


Trên hình 7.15 mô tả sơ đồ phép chiếu quang học. 


v.Y 


Hình 7.15. Sơ đồ hệ thống chiểu hình 

Hệ toa độ x,y.Z gắn liền với camera và mát phăng xy là mặt phẳng 
chiếu, trục z trùng với trục chính qua tâm thấu kính. Như vậy gốc của hệ 
toa độ xyz qua tâm của mặt phăng chiếu, còn tâm thấu kính có toa độ là 
(o,o,1) với ^ là khoảng cách tiêu cự. Ổ đây, hệ toạ độ x,y,z trùng với hệ 
toa độ cơ bản X,Y,Z. 

Giả sử X,Y.Z là toạ độ của một điểm bất kỳ trong không gian 3 
chiều. Nếu Z > ^„ tức là trường hợp vật thể đang quan sát nằm trước thấu 
kính, từ các quan hệ giữa các hình tam giác trên hình 7,15 ta có: 


xX_ X _ X 
TRE: RẺ PS: ói 
y_Y _ ŸY 
5" n 645 
Từđó: - 
ÀX 
lu WE- (1.27) 


lóo 


ï 4y 
= 7.28) 
Je 

Lưu ý rang các phương trình trên là phi tuyến tính vì còn tỏn tại 
phép chia cho Z. Ở đây cũng có thể đùng ma trận thuần nhất 4x4 để mô 
ta sự biến đổi chiếu hình. Tuy nhiên sự khác biệt cơ bản so với khi dùng' 
các phép biến đối khác trước đây (xem chương HH) là sự không tuyến tính 
nối trên, 

Một diểm M bất kỳ có thể xác định bằng véctơr trong hệ toạ độ 
X.Y,2: 

r=(X,Y,Z)' (7.29) 


Còn ở trong không gian toạ độ thuản nhất (homogeneous 
coordinate), điểm M có thể xác định bảng một véctơ mở rộng F: 


T =(kX, kY,kZ„k) (6.30) 


Như đã trình bày trong chương HI, k là hệ số tý lệ có giá trị khác 
số không và khi k = I thì các toạ độ biểu diễn bằng toạ độ có thực. Như 
vậy, để xác định toạ độ thực của điểm M chia 3 thành phần đầu của vectơ 
mở rộng (7.30) cho thành phần thứ 4: 


Ma trận biến đổi chiếu hình có thể xác định như sau: 


l0 0 0 
0 1 0 0 
Ac=Íl0 0 1 9 G39) 
020: cái 
Â 
Vậy tích của A, T là mội vectơ T, 
10 0 0Ì røy kX 
0 1 0 0| lạy ki 
oi iảja 1n N6 kZ (1.32) 
Me = 3 k v 
Ạ ni 
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Các thành phần của véctơd mở rộng T, là toạ độ của camera 
trong không gian toa độ thuần nhất. Để xác định các thành phần thực 
trong hệ tọa độ găn liền với camera. tức là các thành phần của véctơ r, 
(x,y,z) chia 3 thành phần đầu của véctơ mở rộng T, cho thành phần thứ 4. 
ta CÓ: 


_#_| 
Xị À¿-Z 
Ÿ 
rL=|Y|F J= (7.33) 
Z Z 
1-2 


Đối chiếu với (7.27) và (7.25) nhận thấy hai thành phần đầu của 
véctơ r, chính là hình chiếu của điểm M (X,Y,Z) lên mặt phẳng chiếu 
của camera. Thành phần thứ 3 không tồn tại trên mặt phẳng chiếu và là 
biến số tự do khi biến đối ngược. 

Biến đổi ngược khi chiếu hình là phép biến đối các điểm từ hình 
chiếu trên mặt phẳng chiếu thành các điểm tương ứng trong khóng gian 3 
chiều, từ phương trình (7.32), ta có: 


T=A4-T (734) 
với: 
ft 0 0 0 
0 1 0 0 
A'= 
€ 0 0 1 0 (3% 
0 0 là lï 
2 


Giả sử ràng (x,„y„„0) là toạ độ của điểm đang xét (rên hình chiếu. 
Giá trị Ô theo toa độ Z chứng tỏ rằng mặt phẳng chiếu nằm ở toạ độ Z = 
0. Có thể biểu diễn điểm này trong không gian toa độ thuần nhất. 


r = (loạ, Địạ,ö,k)” (7.36) 
Thay vào (6.34) ta có: 
T= (xạ, y,,o, k)” (737) 
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và trong hệ toa độ X,Y 2 ta có: 


X 1. 
ESJ 1| đố (L38) 
zZ D) 


Đây là trường hợp không chỉ là hình chiếu của n.ột điểm mà là 
của tất cả các điềm trong không gian X, Y, Z nằm trên cùng một đường 
thẳng - đường thắng đi qua các điểm *(x,„y,,o) và (o,o,À). Như vậy từ 
(7.27) và (7.28) ta có phương trình của đường thắng này trong hệ toạ độ 
X,VY,Z. như sau: 


X 


X=—(A-Z ñ 
. ) G39) 
Y 

Y= (4-2) .40) 


Rõ ràng là nếu chỉ biết toạ độ hình chiếu của một điểm (x,.V,) trên 
mật phẳng chiếu thì chưa đủ để xác định vị trí của điểm đó trong không 
gian 3 chiều, mà cần phải bổ sung thêm thông tin khác, ví dụ, toạ độ Z. 
Bởi thế thành phần thứ 3 của véctơ r, phải là biến số tự do thay vì số o 
(xem 7.36) tức là: 


(7.41 


~Ñ 


lc | kz (1.42) 
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1 


Sau khi chia 3 thành phần đầu của véctơ mở rộng r cho thành 
phần thứ 4 để biến đối vẻ toạ độ X,Y,Z ta có: 


Àx 
X=— 7 
À4+z Và” 
Ay 
Y=— ¬ 
ALS:Z KIEng 
4z 
H 45 
3m. (7.45) 
Từ (6.45) rút ra Z và thay vào (6.43) và (6.44), ta có: 
Xo 
xXx=—(\@A-Z) (746) 
43 
Y = >(Ä~Z) (4) 


7.3.2. Các phương trình cơ bản của hệ thống camera. 


Các phương trình (7.32) và {7.33) là các phương trình cơ bản của hệ 


thông camera. Tuy nhiên khi thành lập các phương trình trên ta đã xéi 
trường hợp đạc biệt là hệ foa độ camera x,y,z trùng với hệ toa độ cơ bán 
X,Y,Z. Đưới đây xét trường hợp chung khi x.y,z không trùng với X,Y 2. 

Trên hình 7.16 ký hiệu M là một điểm không gian, được xác định 
trong hệ toa độ cơ bản X, Y, 2 và m là hình chiếu của điểm M trên mật 
phàng chiếu, được xác định trong hệ tạo độ x,y,z gắn liền với camera. 

Giá sử camera đật ở tâm khớp quay. xác định bằng bán kính vectơ 
r, X,,Y,,Z,) trong hệ toạ độ X,Y,Z và điểm gốc hệ toạ độ x.y.z đặt ở tâm 
mặt phẳng chiếu, cách tâm khớp quay một khoảng cách biểu thị bằng 
r¿(n„r„ na). Vậy điểm gốc của hệ toạ độ x,y.z xác định trong hệ toạ độ 
X,Y,Z bảng Véctơ F,, 


r,= tụ (7.48) 


Khớp quay ở điểm đặt camera đảm bảo góc quay œ giữa các trục 
x và X, góc nghiêng Ô giữa các trục Z và Z. 


Từ đó ma trận biến đổi hệ toạ độ giữa x.y,z và X,Y,Z, như đã trình 
bày ở chương II], có thể xác định như sau: 


-(1,+h) 
R(x,ø).R(z,9)  —Œ, +”) 
As= | —(2, +) (C749) 


0 00“ ị Ì 
Trong đó: 
l 0 0 0 
Nibớïe 0 cosz snz 0 
0 —sinz cosz 0 (30) 
0 0 0 | 


L1 


cosđở  sinở 0 0 
—=snØ cosở 0 0 
0 0 0 1 : 


Sau phếp biến đổi (7.49) có thể áp dụng trường hợp (7.31). (732) 

ta CÓ: # : 

t.= 4 AT (7.52) 
7.3.3. Phép chiếu hình lập thể (stereo). 
| Như ở phân trên đây đã đề cập tới, một điểm trên mặt phẳng chiếu 
có thể là hình chiếu của nhiều điểm trong không gian, vì thế chưa thể xác 
định được vị trí thực của nó trong không gian 3 chiều. Để hình dung được 
chiều sâu của hình ảnh. cần đến phép chiếu lập thể (stereo). 

Phép chiếu lập thế cần đến 2 hình chiếu x;,y, và x;,y; của cùng 


một điểm M trong không gian (hình 7.12). Khoảng cách giữa 2 tiêu cự 
của 2 thấu kính gọi là khoảng chuẩn B. 


Hình 7.17. Sơ đồ phép chiếu lập thể 
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Nhiệm vụ đặt ra là phải xác định được các toạ độ X,Y,Z của 
điểm M thông qua các toa độ hình chiếu x,.y, và x;,y; của nó. Giả sử rằng 
các camera như nhau và cả hai hệ toạ độ gắn liền với camera hoàn toàn 
trùng khớp nhau, chỉ khác vị trí gốc ban đầu. Cũng như ở phần trên, khi 
cho các hệ toạ độ găn liền với các camera trùng với hệ toa độ cơ bản thì 
mặt phẳng chiếu xy trùng với mặt phẳng XY. Khi làm như vậy toa độ Z 
của điểm M được giữ như nhau đối với cả 2 hệ toa độ camera. 


Khi cho hệ toạ độ camera thứ nhất trùng với hệ toa độ cơ bản 
X,Y,Z như hình 7.I§ ta có: 
Xị 
X\ nhau (7.53) 


Tương tự làm như vậy đối với camera thứ 2, ta có: 


x 
X,= 2(4-Z,) C159 


(X;,ÿ) 


Hình 7.18. hình 7 17 nhìn từ trên xuống khi cho trùng 
hệ toa độ camera thứ nhất uới hệ toa độ cơ bản XYZ 


Nhờ cö các điều kiện, như đã nêu ở trên: 
X;=X,+B (155 
Z,=7Z =7. (1.56) 
từ (7.53) + (7.56) ta có: 


X,=X,+B= .A-Z,) (1.57) 
Xị 
X.= SE núi (7.58) 


và từ (7.56) và (7.58) ta nhận được: 


cà 
Xa =#i 


Z=À- 


(7.59 


Như vậy các tọa độ X,Y.Z của điểm M trong không gian 3 chiều 
hoàn toàn được xác định bằng (7.39), (7.40) và (7.59). 


7.3.4. Mô tả quan hệ robof và camera. 

Phương trình (7.34) cho biết tọa độ điểm của vật thể trong không 
gian 3 chiều X,Y,Z (vectơ T ) thông qua thông tin về hình chiếu của 
điểm đó (vectơ f ) trên mặt phẳng chiếu của camera. Ma trận (7.35) mô 
tả sự chuyển đối,từ hệ tọa độ gắn liền với camera sang hệ tọa độ cơ bản 
và có thể biểu thị tổng quát hơn cho cả vật thể là ma trận CAM. 


Theo các ký hiệu đã trình bày ở phần ví dụ trong phần 7.2.2 thì P 
mô tả vị trí trạng thái (vị trí và định hướng) của chiếc chốt vật thể trong 
hệ tọa độ gốc (hệ tọa độ cơ bản X,Y,Z). Vậy ở đây có thể biểu thị: 


P=CAMPC (7.60) 
với PC mô tả vật thể đang xem xét trong hệ tọa độ gắn liền với camera. 


Trong những trường hợp vị trí trạng thái của vật thể được xác định 
theo mối quan hệ bố trí không gian của robot, ví dụ (7.19), thì từ (7.60) 
có thể xác định ma trận chuyển đổi từ hệ tọa độ gắn liền với camera sang 
hệ tọa độ cơ bản: 


CAM=PÐPPC† (7.61) 
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64. THỂ HIỆN CHƯƠNG TRÌNH THAO TÁC CỦA 
ROBOT 


Chương trình thao tác của robot thực hiện các nhiệm vụ được 
giao. Nhiệm vụ đó được mô tả bằng một đãy liên tiếp các vị trí thao tác. 
Trong ví dụ ở phân 7.2.2 là các thao tác từ p, đến p, (hình 7.8). Các thao 
tác này được thể hiện bằng một chương trình, trong đó từ các phương 
trình từ (7.5) đến (7.12), tương ứng với các thao tác từ p, đến p,. cản xác 
định ra T, ứng với mỏi vị ní trạng thái của điểm cuối của cánh tay robot 
trong hệ toạ độ cơ bản (hệ toạ độ cố định). Ví dụ, ứng với thao tác p›, từ 
(7.5) ta viết: 


Z.T,E=PPA (762) 
ta CÓ: T,E=Z'PPA 1.63) 
và cứ thế, tiếp đến p; cho đến p,. 


Nhưng trước khi thể hiện chương trình các thao tác đó, cản sử 
dụng thêm 2 biến: 


COORD - mô tả hệ tọa độ ứng với vị trí đang xét. 
TOOL - mô tá dụng cụ đang được sử dụng. 


Như vậy tất cả các phương trình (tương tự 7.6.3) ứng với các vị trí 
thao tác đều có thể viết dưới đạng sau: 


T, TOOL = COORD POS (7.64) 
Vị đụ, ứng với thao tác p,, ta có 
COORD: =-Z+P; 
TOOL : = E; 
và thao tác là: MOVE PA; 
Trong cách viết trên, dùng dấu (+) để chỉ phếp nhân ma trận và 
dấu (-) để chỉ phép nhân ma trận nghịch đảo. 
. Theo đó, chương trình thể hiện các thao tác của robot từ p, đến p, 
có thể viết như sau: 


TOOL:=E ; Gán dụng cụ 
FORI:= 1,2 DO 
BEGIN 
READ (CAMERA. PC) ; Thông tin từ camera 
P:= CAM +PC; Vị trí của chốt 
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END 


COORD :=-Z+P; 


Toa độ của chốt 


MOVE PA : Hướng tới chốt 

MOVEPG : Sắp kẹp chốt 

GRASP : Kẹp 

TOOL : =E - PG: Dụng cụ bây giờ bao gồm 
bàn kẹp đã kẹp chốt. 

MOVE PD ; Vị trí xuất phát (bắt đầu 
mang chốt đi) 

HT: = HR [1]; Vị trí lấp vào lỗ 

COORD:=-Z+H+HT: Toạ độ của lỗ 

MOVE PHA : Hướng tới lồ 

MOVE PCH: Chaạm vào lỗ 

MOVE PAL; Đặt đồng tâm với lỗ (lúc 
chuân bị lắp) 

MOVE PN: Lắp vào lỗ 

RELEASE ; Đời đi 


COORLD: = -7+H+HT+PN 
TOOL :+E 
MOVE PA 


Toa độ của lỗ đã lắp 


7.5, CHUYỂN ĐỘNG GIỮA CÁC ĐIỂM TỰA. 
7.5.1. Đặt vấn đề 


Như đã trình bày ở chương V khi lập trình quỹ đạo chuyển động 
tobot đề thực hiện nhiệm vụ đặt ra, thông thường cần biết vị trí và định 
hướng của khâu tác động cuối của robot ở những điểm khác nhau trong 
không gian thao tác.Gọi chúng là các điểm na . Các điểm tựa này bao 
sồm các vị trí bắt buộc phải đi qua để thực hiện nhiệm vụ và cả những vị 
trí cũng phải đi qua để tránh chướng ngại vật trên đường đi. Tuỳ theo 
công việc và môi trường làm việc của robot mà quyết định số lượng các 
điểm tựa. Khi biết vị trí và định hướng của khâu tác động cuối theo các 
phương pháp giải bài toán động học ngược. xác định được các giá trị biến 
khớp (toa độ suy rộng) để điều khiển chuyển động của từng khớp động và 
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tổng hợp lại thành chuyển động chung của robot theo một quỹ đạo nhất 
định. Hay nói chính xác hơn là theo các điểm tựa của quỹ đạo. Ở phần 
này. khảo sát sự chuyển động giữa các điểm tựa đó là để chọn ra những 
qui luật chuyển động hợp lý. Các ràng buộc ở đây có thể là gia tốc và vận 
tôc chuyển dịch, còn các hạn chế do chướng ngại vật trên đường đi đã 
được định trước bằng vị trí các điểm tựa bổ sung. Ở phần cuối sẽ xem xét 
đến các hạn chế về động lực học khi chọn lựa quy luật chuyển động của 
robot. 


Có 2 cách tiếp cận vấn để vẻ chọn lựa quy luật chuyển động hợp 
lý giữa các điểm tựa. 

Cách thứ nhất thường tiến hành trong hệ toạ độ suy rộng, tức là 
trong không gian các biến khớp q; (t). Khi đó, nếu cho trước các điều kiện 
như đảm bảo độ liên tục và điều hoà ở những điểm chuyền tiếp. có thể 
xác định các hệ số của hàm đa thức biểu thị gần đúng đường cong quỳ 
đạo. 


Cách thứ hai thường dùng trong hệ toạ độ Đề các. Lúc đó cho 
trước đạng hàm giải tích, ví dụ, hàm bậc nhất biểu thị quỹ đạo gồm nhiều 
đoạn thăng nối tiếp nhau. Sau đó, thay thế gần đúng quỹ đạo này bằng 
quan hệ hàm tương ứng của các biến khớp. 


Như vậy lập trình quỹ đạo qua các điểm tựa có thể tiến hành trong 
hệ toạ độ các biến khớp hoặc trong hệ toạ độ Đề các. Khi lập trình trong 
hệ toạ độ các biến khớp, cần biết quan hệ q,() và các đạo hàm bậc nhất và 
bậc hai của chúng. 


Lập trình quỹ đạo trong hệ toạ độ các biến khớp có các ưu điểm 
Sa: 


L) Cho biết thông tin về biến khớp là những thông số điều khiển 
trực tiếp các khớp động; -' 


2) Vì vậy có nhiều khả năng đảm bảo thời gian thực trong điểu 
khiển; 
3) Việc lập trình dẻ dàng hơn. 


Nhược điểm chính là thông qua giá trị của các biến khớp chưa thế 
hình dung ra ngay Vị trí của cơ cấu tay máy trong không #ian, mà vì vậy 
phải tính toán nhiều lần, ví dụ, để kiểm nghiệm xem có bị chạm vào các 
vật thể xung quanh không. 


Thường dùng hơn là cách thức sau: từ toạ độ các điểm tựa giải bài 
toán động học ngược để tìm giá trị các biến khớp, rồi dùng phếp nội suy 
xấp xỉ bằng hàm đa thức bác thấp để xây dựng quy luật thay đổi thích hợp 
các giá trị biến khớp, tương ứng với quỹ đạo qua các điểm tựa bắt buộc. 
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Có nhiều phương pháp giải quyết vấn đề này, ví dụ, mô tả quỹ 
đạo gôm nhiều đoạn thẳng nối tiếp hoặc dùng Spline bậc 3 v.v.. 


7.5.2. Mô tả quỹ đạo bàng Spline bậc 3. 


Sphine bậc 3 là phép nội suy hàm đa thức bậc 3 để đám bảo sự liên 
tục của đạo hầm bậc nhất và bậc 2 tại các điểm tựa. Phương pháp này cho 
: phép xây dựng quy luật xấp xi với độ biến đối đều hoà và độ chính xác 
„ cần thiết. 


Xét _. dưới đây trường hợp quỹ đạo bắt đầu từ điểm xuất phát và 
đi qua 5 điểm tựa, Khi dùng Spline bậc 3, mỗi đoạn quỹ đạo được mô tả 
bằng một đa thức bậc 2: 


hịŒ) = an ĐÍ + a; + ái LÐ âu (765) 
với † - thời gian quy đối: 


t=—=—; re[r,,r,], £e[04] 


+ - thời gian thực, tính bằng giây; 
+, - thời gian (thực) ứng với điểm cuối của đoạn quỹ đạo thứ j; 
- thời gian (thực) ứng với điểm đầu của đoạn quỹ đạo thứ j. 


a, - hệ số thứ ¡ của đa thức ứng với đoạn quỹ đạo thứ j, 
‡=1,2.3.4.n(mn là đoạn Cuối), 


Trên hình 7.19 trình bày các đoạn quỹ đạo mô tả bằng Spline bậc 
3. Điều kiện biện của các đoạn quỹ đạo cũng ghi trên hình vẽ, bao gồm 
giá trì q, ở các điểm tựa, vận tốc v, và gia tốc a,. 

Đạo. hàm bậc nhất và bậc 2 của hàm đa thức h(t) theo thời gian 
thực ch tính như sau: 


_ đó mộ k— SA dhÐ)— 
: LTR dt. di rTt., đi 
Lđhứ 1, __ Ở.66 
=— ———= —h{í $ J= 1,2..." 
._t — đf f J Sự tổ 


# 1 
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dt — (Œ,T=r ` “đ” 


1%») |Jn() |#y( (1) L2) 


GÀ U20 05. GHI SG. Chi oi SH ® ~| 
Hình 7.19. Mô tả quũ đạo bằng Spline bậc 3. 
Các hệ số a, được xác định từ các điều kiện biên này. 
Đoạn quỹ dạo thứ nhá? mô tả băng đa thức sau: 
hị@ = aịt 3 AjzU +ãjjE † âu (1.68) 


Ở vị trí xuất phát t =0 và qụ biết trước, ta có: 


h(0) = aạ =4, (769) 
h(o 
= (Ø) _ đa. 
là là 
Từ đó, ta có : ai = V,t, 
2 n 
>2. đt (770) 
3ị› =..—== #: “Măcơ; 
2 


1279 


và đo đó ta có: 


lá S2 (6) = 2a; sêni 
o t t (7.7 


Ỡ vị trí t =], ta có: 


2 


q,Í 
T(f) = ø; + 2 + Ví +đ, = đị (172) 
- Từ đó, ta có: 
2 
đí : 
đ; = ði —V„Í — 3 (7.73) 


Ở đây cũng như về sau dùng ký hiệu ỗ,=q, - q,, 
Như vậy, đoạn quỹ đạo đầu tiền được biểu thị bằng phương trình 


Sau: 


at at 
=5 2 3 ø'1 2 : 
hữ) — (ói = v.Ý = z )f +( g) }/ + (vh}⁄/ tự, (7.74) 
Từ đó, xác định vận tốc và gia tốc tại điềm cuối của đoạn quỹ đạo 
thứ nhất: 
ñ(D v_ 3ối -(2!)/2-2v, _ 3ð, 


al 
n2 UY... 
TP ñ t GP. IN .... 


(1) 6ô,—2a!°-6v!, Bố, 6v, 
nhe a= ` _ E= ố.... (16) 
h Ít Ít Í 


Đây cũng là vận tốc và gia tốc tại điểm đầu của đoạn quỹ đạo thứ 
hai. 


Đoạn quỹ đạo cuối được mô tả bằng đa thức sau: 
3 2 
h.(f) = auyÉ` + đ„„Ƒˆ + du + đựy (17 


Theo các điều kiện ở điểm đầu (t = 0) và điểm cuối (. =1) của 
đoạn quỹ đạo, xác định: 
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h,(O) = 4 = đ„ cho biết trước (7.78) 


h„() = đựi + đa + đại + đ› £= {; (779) 
h, () ụ 34 kẽ 2đựa BB đa 
—— — —- .ưaneese.-.w=wxxasẹtuươn 1, 

t, ⁄ b. (7.80) 
h()__ 6a,+2a„ | 
kẽ DO) Ko sac (181) 


Giải các phương trình này để tìm các hệ số a„›, a„;, ả„,, cuối cùng 
ta CÓ: 


` đu Đa CHYT: 
h„(†) =(ố, — Vựf, + ạ ` +( 3ó, +3V,f„ — 4,f2)ˆ + 


2 (7.82) 
q1, 
+ Qố„ — 2V,Í„ + ộ )'+đ,„ 
với ð¿=q,-dq._ 
Đoạn quỹ đạo thứ hai được mô tả bằng đa thức sau: 
hạ(f) = day ` + a,yf” + aạ + đạa (783) 
Theo các điều kiện biên ở điểm đầu của quỹ đạo này (t=o) ta có: 
hạ(Ô) = ã¿y = qì (784) 
_ h(ø) _a, _ h0) : 
LH KH... .a (785) 
N6 
do vậy: ãy( = Vit›, 
"(0 2a, @) 
“To Sen d8 S:SEEIESIRP TU (786) 
5 1; Ít 


I§!1 


từ đó: 


lở? 
Với các hệ số này đa thức h;(t) có dạng sau: 


2 


` đIf12 —, 
h; (1) = đt” li TU lái +(,f;)/ tu, 


VỚI: 
3ô at 
¡=— —-29,—-—= 
Í 
6ó 6v 
ch 2, 
Í Í, 


(787) 


(7.88) 


(7.89) 


Thay vào (7.87) các điều kiện t = 1 ứng với điểm cuối của quỹ đạo 


thứ hai, cũng tức là điểm đầu của đoạn quỹ đạo tiếp theo: 
2 
14 
K2 I2 
1q) = q; =a; + 2 + Vụ; + đ, 


hú 3a.. + af} + ví 3a.- 
nu 23 2 122 = Vị + đ#y + 23 
I, I, ộ 
5;q) _ 6á +4; — 6đ; 

Vệ nữ (Pj CỐ 2 c= SỈ 2 

l) Lổ) 2 


Các giá trị q,, v; và a; đều phụ thuộc vào a;;, 


Đoạn quỹ đạo thứ ba được mô tả bằng đa thức sau: 
h.(†) = sản + afˆ + đjf + địo 


Ở điểm đầu t =0. ta có: 


at; 
h;(0) = địa = đ; = 4; Mi + Vi; + đ, 


182 


(7.90) 


(790 


(1.92) 


(793) 


(794) 


h(o) ay,  h() 
V› = = = (795) 
# lễ F› 


kl 


Từ đó. da; = VI, 


Tiếp theo, 
_ h (0) _ 2ũu “ h;(1) Sẻ 
2.3 cận CS (1a = càg (296) 
LÊI là) 1; 
Từ đó ta có: 
x., ð 
ị;ạ — 2 


Thay các hệ số vừa xác định được vào ( 7.93) 1a có: 
at? 
3 2-3 2 
(1) = ` + _: + (M;í;)( + q; (7.97) 


Theo điều kiện biên khi t = 1, ứng với điểm cuối của đoạn quỹ đạo 
thứ ba, cũng tức là điểm đầu của đoạn quỹ đạo tiếp theo, ta có: 


2 
a»(/ 
h,( = đ = q; = vại; + ¬ tán, (798) 
ñ( 3đ. + + — á, 
độ) để 33 1⁄3 ¬... 33 (199) 
LÁ 1; - ï ñ » 
h;({) Ốđ;; + 4g 6đ; 
=Ñq; .-..n —=Q; so m. (7.100) 
! lê ft 


Các giá trị q,, v. và a, đều phụ thuộc vào aaa. 


Đoạn quỹ đạo thứ nnr được mô tả bằng đa thức sau: 


h,() = ở" + at + đ,jÍ + đặu (7101) 


v_ ⁄(@) _ a. _ ĐŒ), 
1%. w`*wé 


2 
anh 
#„(O) = địa = đ; = q; + vif; + 2 + 


Ứng với các điều kiện biên tại điểm đầu , t = 0, ta có: 


đại = Vật, 
Tiếp theo: 
= h„(0) x 24 — h;(1) 
= = =.Sx 
P- 
Từ đó ta có : 
2 
= 4í; 
42 — 
P) 


Thay các hệ số vừa tìm được vào ( 7.101), ta có: 
3 aytt 3 
h„()=a¿;t + MS TÚY +(Vvifj)t+q; 


Theo điều kiện biên tại điểm cuối t =l, ta có: 
2 


a:E; 
h,()=a¿; độ PM DI +q;=dq, 


h„q a,t 
+0) — *t+á¡t,+V; =Vvu=—>-2v,+——= 
tụ Ä n 2 

h,@) bay, -6ồ, ÕV, 

ú Ấn tụ 


(7.102) 


(7103) 


(7.104) 


(7.105) 


(7.106) 


(7107) 


(7.108) 


Từ phương trình này có thể xác định các hệ số a¿., a;;, a¿; ở phần 


trên còn là ẩn số. 
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Cuối cùng có phương trình các đoạn quỹ đạo như sau: 


aạL a,tỷ 
h,(Œ) = (ỗ; — Vạti — s )hm b ng +(Vạt¡)t + đạ(6.109) 


3ð, ạt óỗ, 6V 

V.=—-2vạ-——;a,=—~--——-2a 

\ tụ 2 Ù t tụ 0 . 
3 a1) 2 
h;()=a¿¿t P ng +(vịt;)t+qi 7.111) 
at) 

qạ=âa;; + 2 + Vịf; +dy (7.112) 

3a; 6a 

XÃ h 3 DEN 23 
Vị =V¡ +tayt; + a; =âai+—: (1113) 

2 t; 

3 a,fj 2 
h;(Œ)=a,,t bó RUN, +V;tjt+q; (7.114) 
Ta 

q;=q;+V;i;+———+a;s¿ (7.115) 

đây, .Ê 
Vị =V;+a¿f; † II, a;=a; +— (7.116) 

3 ì 

3 

h,(t)=a¿ y4) #Q; (7.117) 


lạ ) 
h„()=(, =v,t, “s )Ẻ +(38, +3v,L, —a,t2)U + 


#Ế G7118) 
+ô, —2v,L, + . 


đồ, ar{„ 6, ÓV, 
Xóa => —2v,+ : sdạ= _ BH GB. 2a (7.119) 
tạ ? t DU: 
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A;; = L, ) dạ =t TT đa "ti (7120) 
Trong đó: 
, 
xị =k,(u=t,)+k;(t7 ~đ)—k;[@t—t,kx+t{¿ t2) đ.121) 


X; =~=k,(u+t;)+k;(e~t1)+k;[@1—t,)c+t2(u—=t;)](7.122 


LÝ =k,(u~t,)+kK;(d—c)+k;ÍŒ, —f;)c—đ(u—t;)|(7.123) 


D=u(u—t;)(u -t,) (1.124) 
M= + +Í (7.125) 
zỶ 
& “a8 sun (7126) 
V„.~Y,—a,—(a,=a,)w/2 
#,=~———— ————— (7.127 
3 
địnđ, 
R) Ne kh” (7.128) 
c=3u; - 3ut, + t;ˆ (7.129) 
d=3t+3t + t? (1.130) 


6.5.3. Lập trình qữy đạo trong hệ toa độ Đề các 


Trong phần trước đã xây dựng qũy đạo trong không gian các biến 
khớp (toa độ suy rộng) và nội suy bằng đa thức bậc thấp. Mặc dù theo giá 
trị các biến khớp có thể hoàn toàn xác định vị trí và định hướng của bàn 
kẹp trong không gian toạ độ Đề các. Tuy nhiên, để dễ hình dụng trực 
quan hơn, người lập trình cần trực tiếp tiến hành lập trình quỹ đạo trong 
hệ toạ độ Đề các. Nhiệm vụ lập trình là xây dựng qũy đạo chuyển động 
của bàn kẹp. (mặc đầu nói là bàn kẹp nhưng ở đây được hiểu chính xác 
hơn là của điểm tác động cuối, khí đụng cụ đã gắn vào tay máy hoặc bàn 
ken>} đan báo vị trí trạng thái (vị trí và định hướng) của nó tại các điểm 
tựa và nối liên các điểm tựa này với nhau. 


Như đã biết tại từng điểm tựa có thể dùng ma trận thưần nhất 4x4 
để mô tả quan hệ piữa hệ toa độ gắn liển với bàn kẹp và hệ toa độ cơ bản. 


I8§6 


Giá trị các biến khớp tại các điểm tựa này được xác định theo các 
phương pháp giải bài toán động học ngược. Như vậy ma trận 4x4 nói trên 
cũng hoàn toàn xác đỉnh. chỉ còn việc đi chuyên từ điểm tựa này sane 
điển tựa kia là chưa xác định. Theo phương pháp trong {7] từ điểm tựa 
này sang điểm tựa kia có thể thực hiện bằng cách di chuyển theo đường 
thăng nối hai điểm và theo các chuyển động quay để đảm bảo định hướng 
tới của bần kẹp. 


Trong trường hợp này chúng tì viết: 
T,=€ (ĐP, (7.131) 


với T, - ma trận thuần nhất 4x, mô tả định vị và định hướng của bàn 
kẹp trong hệ toa độ cơ bản. 


P,- ma trận thuần nhất 4x4, mô tá định vị và định hướng của vật 
thể đối tác khi bị kẹp giữa bàn kẹp đang ở vị trí thứ 1 trong hệ toạ độ tham 
chiếu thứ j của vật thể đối tác. 


C) - ma trận thuần nhất 4x4, mô tả quan hệ giữa hệ toa độ tham 
chiếu của vật thể đốt tác so với hệ toa độ cơ bản. 


Quan hệ này có thế thay đổi theo thời gian t, hoạc không đổi. 
thậm chí bằng ma trận đơn vị, nếu hệ toa độ tham chiếu này trùng với hệ 
toa độ cơ bản. 


Nếu chọn gốc hệ toa độ tham chiếu của vật thể đối tác trùng với 
điểm thứ (+1) khi xét chuyển động của điểm thứ ¡ thì ta có: 


T = C...É) Tái (7.132) 


Theo [7] việc di chuyển từ điểm thứ ¡ tới điểm thứ (i+1) có thể mô 
tả bằng ma trận D(2), bổ sung vào (7.132), tà có: 


T; (2) = E00 P..„, ĐỘ) (7133) 


lá 
Â =—.24<{[0,1 
02000 21) 


t- thời gian thực tính từ điểm đầu của đoạn quỹ đạo đang xét; 
T - tổng thời gian dị chuyển trên đoạn gũy đạo này, 
Vậy 2. là thời gian quy đổi không thứ nguyên. 
Ở điểm đầu của đoạn quỹ đạo. điểm ¡: 1 = o: 2= o: D(o) bảng mà 
trận đơn vị và ở điểm cuổi đoạn quỹ đạo điểm ¡ +1, thìt=T;^= l và 
Pa = Pu¿ID(1) (7.134) 
187 


Từ đó ta có: 
D()= (Pu. (Pu): (1.135) 


Như đã biết, có thế mô tả định vị và định hướng của bàn kẹp (khi 
đã kẹp vật thể đối tác) tại các vị trí điểm tựa ¡ và (+l) bằng các ma trận A 
và B sau đây: 


... P 

P ¬. : sẽ "W J3 | ịn 5v, 3. PP. 

mm in s* a^ pị |0 0 0 1L] H6 
0 0 0 | 


0° /W: 70,“ ï- JPBIND 


Trên cơ sở (7.135). (7.136) và (7.137) ta có: 

n,.nạ n.,s, n,.a; n..(Pg—D,)|... 

S..ng S,.4%; S..Aa S,Á(Pa—DÐA) 

a..n, a,.5S; Aa,.Ap 2,.(Pạ—DP,) 
0 0 0 | 


DA)= (7138) 


Dấu chấm (.) giữa hai thừa số (ví dụ, n..n,) là ký hiệu phép nhân 
vỏ hướng vectƠ, 


Ma trận D(2) có thể biếu thị bàng một quan hệ hàm sau [7]: 


D@\) = L(L) R„() R;(.), (1.139) 
ILÌl 0 0 ^x 

với LAẠ)= Ti (1.140) 
§- 3Ú: l: ⁄Â; là 
0 0 0 1) 
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SỀVA8+CAØ -S,C„VAØĐ C„S26) 0 
2 
R,@)= -8uCvVA®) C,VA®) +CA@) S509) 0 


~C,§(A6) ~S„5(A9) cáo 0| (14D 
L 0 0 0 | 
C(o) -S(À@) 0 0 
Rạ(@À)= Tn NÓI ' : (7.142) 
0 0 0 1 
trong đó 
V(AO)= 1 - cosÀ®Ð) 
C(49) = cos(AÐ), S(A9) = sin(A6) 
C(2@) = cos( 4@). SLÀØ) = sinØ) ' 
và ÀAc [0.1]. 


*Ta trạn Ñ, mô tả sự quay ở vị trí tại điểm ¡, gốc quay Ô quanh 
vectơ hướng tới a.. Ma trận R„(4) mô tả sự quay ở vị trí tại điểm (i+l), 
góc quay @ quanh vectơ hướng tới â, - 


Thay (7.140), (7.141) và (7.142) vào (7.139), ta có: 


ồn ðös ôa ðp 
4)= 143 
1. 


VỚI 
[ ~ S(Aø)ISỐ V48) + C61]+ C(A@J(<5 CV) 
hc "¬....... 
~ Š(Àø)[~C, 509)]+ CQ9)(~S 529) 
C509) ÀXX 


Ša =|S5v,S50)|: Šðp=|Xy|; ôn =ösxôa. 
C(^ÀO}) À.7 


So sánh các phần tử tương ứng của 2 ma trận (7.138) và (7.143) 
Khi ^ = I. tả CÓ: 
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x=a.(P;, - Pa) 
y=S - (Đụ - Đa) (1.144) 
Lông đẠ Ề (Đụ E Pạ) 


Ủng với các phần thứ 3 ta có: 


Sà 
\/ = arcfg 


—TL€\/Š (1145) 
n..aụ 
`. 
[(n..ng)+(su.ag) L” 
0Ð =arcftg—— (0<Ô<m) (7.146) 
Aa‹âp 


Cuối cùng, tìm biều thức tính œ: 


Sọ =- SuCV(29) (n.n,)+ [CsyV(0)+ C (10)] (sung) - 


- 3,8 (19) (n..nụ) (7.197) 
Có =- S„CuV(A0) (n,.Sa)+ [CSuVO.Đ) + C(A0)] (S..Sn) - 
- SuS (18) (nụ.n,) (6.148) 
Sụ 
(= arcfðg—— —TUL<€t(p<7t (7.149) 
C, 


D(A) được gọi là hàm dẫn. Tùy theo các yêu cầu định hướng bàn 
kẹp mà xác định D(2), còn vị trí tâm bàn kẹp được di chuyển trên đường 
thẳng nối 2 điểm tựa. Nhiều khi lại còn phải dùng đoạn cong chuyên tiếp 
giữa 2 đoạn quỹ đạo đường thẳng để tránh sự thay đổi đột ngột vẻ tốc độ 
di chuyển. 


Trên đây đã trình bày trường hợp xây dựng quỹ đạo giữa 2 điểm 
tựa ¡ và (+L), theo đề xuất trong [7], như một ví dụ. Theo đó, vị trí tâm 
bàn kẹp được di chuyển đọc theo đường nối 2 điểm tựa. Trong khi đó bản 
thân bàn kep thực hiện các chuyển động quay (tại vị trí quay phức hợp với 
sóc 8 và #, còn tại vị trí (+l) góc quay 0). Đoạn cong chuyển tiếp tại 
điểm giao nhau của 2 đoạn quỹ đạo thẳng, được xây dựng như phép nội 
suy bậc 2. 


“Trong thực tế còn có thể thực hiện quỹ đạo duz:tác điểm tựa bằng 
` nhiều phương pháp khác nhau và phải xét tới các đặc điểm công nghệ. 
Tuỳ theo loại hình công nghệ được robot phục vụ mà xác định các đặc 


100 


tính động học, động lực học tại một số điểm tựa quan trọng để đưa thêm 
. các điểu kiện ràng buộc khi xây dựng quỹ dạo đi qua các điểm tựa này. 
Trong phần 7.5.4 tiếp theo sẽ giới thiệu thêm một phương pháp xây dựng 
quỹ đạo qua các điểm tựa và có xết tới các ràng buộc vẻ động lực học. 
Còn dưới đây (à một ví dụ vê phương pháp lập tình quỹ đạo qua các điểm 
tưa. 

Trên hình 7.20 là sơ đồ thao tác của một robot có nhiệm vụ lấy 
các chiếc định ốc trong ổ chứa để lắp vào các lỗ và đi qua các điểm tựa 
theo quỹ đạo là các đoạn thẳng. 


Hình 7.20. Sơ đồ thao tác của robot qua các điểm tựa 


Theo nhiệm vụ đật ra đó ra thiết lập các phương trình ma trận tại 
các vị trí điệm tựa Khác nhau: 


Ö điểm P,:  [BASE](T,][E] = [P,Ì (7.150) 
Ở điểmP,: [BASE]{T,JIEI = [B0]{P,] đ.159 
Ở điểm P,: [BASE]ƒT,]{E] = 1BOIfP,] (7:152) 
Ở điểm P,: [BASE][TT,IIE] = [B0][P- (7.153) 
Ở điểm P,:  [BASEIIT,][E] =[BR]IP,] -fi.154) 
ỞÖ điểm P,:  {BASE][T,I(E] = (BR]{P‹I (2155) 
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Trong các phương trình trên đã dùng các kí hiệu sau biểu thị các 
ma trận thuần nhất 4x4: 


{BASE] - ma trận quan hệ giữa hệ toa độ cơ bản x,y,z gắn liền với 
robot và hệ toa độ cố định Xạ,Vo,Za- 


{B0} - ma trận quan hệ giữa hệ toạ độ gắn liền với vị trí của ổ chứa 
đỉnh óc, so với hệ Xu,Vu,Z. 
[BR] - ma trận quan hệ giữa hệ toa độ gắn liên với vật thể có các 
lỗ lắp định ốc, so với hệ Xu,Y,.Zu. 


[P,] - ma trận quan hệ giữa hệ toạ độ gắn liền với vị trí xuất phát, 
SƠ VỚI hỆ Xu, Yụ, Zu. 

[P,].IP:l.[P;} - các ma trận quan hệ giữa các hệ toa độ gắn liền với 
các điểm tựa P¿, P,. Pạ, so với hệ toa độ liên quan với [BO]. 

[P,)[P⁄l - các ma trận quan hệ giữa hệ toa độ gắn liền với các điểm 
tựa P, và P., so với hệ toa độ liên quan với [BR]. 

[T,] - ma trận quan hệ giữa hệ toạ độ gắn liền với điểm cuối của 
tay máy,và hệ toa độ cơ bản X,ÿ,Z, 

[E] - ma trận quan hệ giữa hệ toạ độ gắn liền với bàn kẹp so với 
hệ toa độ [1š]. 


Để biểu thị sự dịch chuyển từ điểm P, đến P.. (¡ = 0.1,2,3.4) dùng 
ma tràn P,„„¡. Ví dụ ,khi mô tả sự chuyển dịch từ P, đến P, ta viết lại 
(7.150) trong hệ toa độ P.; 


[T4] = BASET'[P,.J[EI' (7.156) 
và trong hệ toạ độ P\, ta có 
[T,l = [BASE]'[BO]{P,,JIET' (72.157) 
Từ (6.156) và (6.157), ta có 
[P;,] = [BOT [P.„] . 


Như vậy, việc đi chuyển từ vị trí điểm tựế, đến vị trí điểm tựa P, 
dọc theo đoạn thẳng nối chúng với nhau, cấu hình của tay máy thay đổi từ 


[T.] = [BASET'[BOI(P,,]IEI' (.159) 
sang cấu hình sau: l 
[T¿] = [BASEJ” [BO]IP,,JIE]' (7.160). 
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7.5.4. Mô tả quỹ đạo qua các điểm tựa bàng đa thức bậc 3 có 
xét đến các hạn chế về động lực học. 


Trên đây đã mỏ tả quỹ đạo qua các điểm tựa dùng Spline bậc 3 
hoác các đoạn thẳng nối liên tiếp chúng. Tuy nhiên cả 2 phương pháp đều 
chưa xét đến các hạn chế về lực và mômen, vận tốc và gia tốc của các bộ 
phân truyền dân ở các khớp động. Theo [7] dùng đa thức bậc 3 để mô tả 
quỹ đạo qua các điểm tựa và chú ý đến các yếu tố động lực học này từ 
đầu thì có thể nhận được quỹ đạo chuyển động trơn tru và đều hoà. 

Ký hiệu Q, () là đa thức bậc 3 biểu điển sự biến thiên của biến 
khớp (toa độ suy rộng) thứ j giữa 2 điểm tưa B, và B,„, trong khoảng thời 
gian {t,, t„,]. Vấn đề là phải "nối ghép" các đa thức Q, này lại (I = 1,2, 
...-L) sao cho quỹ đạo phải đi qua các điểm rựa và đám bảo tính liên tục 
về hành trình. vận tốc. gia tốc trong suốt khoáng thời gian [t, 1,]. 


Vì Q,(0 là đa thức bậc š nẻn đạo hàm bậc 2 của chúng là hàm bậc 
nhât theo thời gian t: 


% tụy mĐị z (t—t,)›. 
Q;()= -;(,)+ : Q;(t 1) (7.161) 
ủ, u, 
với I=l,2,...n-l; 
J=I1.2...N 


u, - thời gian di chuyển trên đoạn đường thứ iu, =t„,-t,. 


Lấy tích phân 2 lần với các điều kiện biên: 
Q; (L) = q; Ũ Q, (t.) = q; trì 


ta CỐ: 
ậ ¡(t,) Ệ Ị lá Ậ 
Q,a= 7 No 052 St 
l U, 
Ạ\ . (2.162) 
u,Ö.(t; uỌØÖ,(t 
L] đuêc - bà n .Q;( = 
_" 6} lu 6 | 
i=1⁄2,..n- 1; j=12...N 


Như vậy đối với các điểm ¡ = I, 2.... n-1 thì Q, (0) là xác định nếu 
biết các đạo hàm bậc 2 của chúng tại các thời điểm t, và t,... 

Trên cơ sở đó ta có (n - 2) phương trình tuyến tính với ấn số 
Q,(1),1=2 „..n-l: 
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Q;Œ;) 
ẦA Q„ đt; ) 
Q= : (7.163) 
Ồ,,„( nxi) 
3m”, SẼ 2„; +— 1a 0 0 
tà 
Am... Hy 
lơ) 
0 ÙÃ 2(„ +1u,) 
Hà 20, + Đ„_3) 
: 0 . 
0 0 0 
0 0 0 0 
Hạ 3 ÿ 
n 
2(u,; S tạ ;) n2 — = 
tÌn_¿ 
2 
0 0 M,-; '3u,¡+2u, ; +— 


n—3 
l u2. 
X=_= Ì:. VỤD, ¡+ TL 
Đụ ¡ tạ; 
6q, 
+6 i2 Hi iế 
Uạ¡ Úạ ¡Ủa ; 


Nếu u, luôn luôn dương, từ phương trình (6.163) ta có: 
_ Gi : 
O=⁄4+b ‹ — 164) 


và sau khi thay vào (7.162) sẽ nhận được biểu thức xác định Qj(). Như 
vậy Q,() phụ thuộc vào khoảng thời gian u, vào các giá trị của biến 
khớp, của vận tốc và gia tốc tại các điểm tựa. 

Để tăng năng suất thao tác, tay máy phải thực hiện quỹ đạo 
chuyển dịch với thời gian ngắn nhất. Có thể đặt bài toán tối ưu chọn 


khoảng thời gian u, sao cho tổng thời gian T là min trong phạm Vị giới 
hạn về vận tốc, gia tốc và lực suy rộng. 
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Hàm mì. tiêu: 
T=>u, -> min (1.165) 


Giới hạn về vận tốc: 


|0,(|< V, 


Giới hạn vẻ gia tốc: 


lÒ,@]< V, j=L2....N 
: I=l,2,...n—Ï 
Giới hạn về lực: 
J=1⁄2...N 


[Fujl <F, 
Trong đó Vị A, và F, là các giá trị giới hạn vẻ vận tốc. gia tốc và 


lực suy rộng đối với khớp động thứ j. 
Các điều kiện giới hạn nói trên cố thể viết chỉ tiết hơn như sau: 
tới hạn về vận tốc: 

Lấy vi phân biểu thức (6.162) và đặt: 


Q,(t,)= @, (7.166) 
QŒ,..) — @ (1.167) 
ta CỐ; 
ˆ G@ © uài b) 
Ó,()=—T(t,„„„-t)Ẻ+—h~q-t,}+ 
: 2U 2u, 
7.68 
- ki na. sÍ q¡ U,0; W ) 
U, 6 U, 6 
z Œ ji+i €, 
II) on 0/00 ng Làm 7 È1.169) 
u u : 


| L 
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Trong đó œ, - gia tốc góc tính bằng (7.166) tại điểm tựa B,ở thời 
gian (. Trong khoảng thời gian Ít, t,.,] vận tốc có thể đạt cực đại tại thời 
điểm t, nào đó. Tại thời điểm t này ta có: 

O,ứ, )=0 C1170) 

Như vậy điều kiện giới hạn về vận tốc có thể biểu thị như sau: 


max ©„|= max|Ó,„(t, |, SEUN! @,@;)]< V, 
: ( 


cẽt[1,ni+1] 


T51 lì 
|2 (1y f=lc + dvlÏ 
Trong đó: 
° @Œ, q dị (Œ; = 0n 2U: 
_Ắ({.)| = } U + + J + ] - 
;63 „ u, 6 
\Q;;.J|= Đúng „đun — 4í (0, 8U) 
Tà Ni Ï u, 6 ¡ 
Q,())= “nh J*C? —@,;,¡); „ tủa =dQị 
2(®; —@¡.¡) 6 u, 
0 Nếu ø, #@,,„ t¡ e[t,,t,„.Í 
Nếu @œ¡ =@,,„ t.#Ïtt2Ï 


Giới hạn về gia tốc : 


Với quỹ đạo hành trình đã biểu thị bằng các đa thức bậc 3 thì 
quan hệ gia tốc theo thời gian là hàm bậc nhất, cho nên trong khoảng thời 
gian [t, t.„]} gia tốc lớn nhất đạt hoặc ở thời điểm t, hoặc t,., và bàng giá 


trị lớn nhất trong 2 giá trị |@,| và |eo, „„.|. 


Vậy điều kiện giới hạn về gia tốc có dạng sau: 


ni 


Max| 


| J" 


tế }<A (7.L72) 


ly 
J0 0 22 5 026 xảy N 


Giới hạn về lực sẽ được khảo sát ở chương sau. 
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CHƯƠNG VI 


ĐỘNG LỰC HỌC ROBOT 


8.1. NHIỆÊM VỤ VÀ PHƯƠNG PHÁP PHÂN TÍCH 
ĐỘNG LỤC HỌC ROBOT. 


Nghiên cứu động lực học robot là giai đoạn cần thiết trong việc 
phân tích cũng như tổng hợp quá trình điều khiến chuyển động. Trong 
nghiên cứu động lực học robot thường giải quyết hai nhiệm vụ sau đây: 


+ Nhiệm vụ thứ nhất là xác định mômen và lực động xuất hiện 
trong quá trình chuyển động. Khi đó quy luật biến đổi của biến khớp q(t) 
xem như đã biết. 


Tính toán lực trong cơ cấu tay máy là việc rất cần thiết khi chọn 
lựa động cơ, khi kiểm tra độ bền, độ cứng vững và tín cậy của tay máy. 


+ Nhiệm vụ thứ hai là xác định các sai số động tức là độ lệch so 
với quy luật chuyển động theo chương trình. Lúc này phải khảo sát các 
phương trình chuyển động của cơ cấu tay máy, đồng thời xem xét các đặc 
tính động lực của động cơ. 


Có nhiều phương pháp nghiên cứu động lực học robot, nhưng 
thường gặp hơn là phương pháp động tĩnh học và phương pháp dùng 
phương trình Lagrange bậc 2. 


Phương pháp động tính học xây dựng trên nguyên lí D' Alembert 
cho phép xác định các lực truyền dẫn để thực hiện chuyển động của bàn 
kẹp cùng vật kẹp, đồng thời cho phép xác định lực quán tính trong các 
khớp. 

Phương pháp dùng phương trình Lagrange để xây đựng mô hình 
động học robot cũng là phương pháp hiệu quả và thuận tiện cho việc xây 
dựng thuật toán giải trên máy tính, cả đốt với trường hợp xét tới tính đàn 
hồi của các khâu. 

Đưới đây áp dụng phương pháp dùng phương trình Lagrangc bậc 
2 để xây đựng mô hình động lực học của robot. Đồng thời với việc sử 
dụng mô hình động học kiểu DH (Denavit - Hartenberg) có thể nhận 
được các phương trình động lực học robot ở dạng vectơ ma trận, rất gọn 
nhẹ và thuận tiện cho việc nghiên cứu giải tích và tính toán trên máy tính. 


198 


Các phương trình động lực học robot được thiết lập đựa trên cơ sở 
phương trình Laprange bậc 2: 


d{ ôL ØL : - 
=—|=S=—= =Hữụu. 11c (U) 
dr(ổ4,/ 2q; : 
Trong đó: L - hàm Lagrange L=K-, (8.2) 


K vàP - động năng và thế năng của cơ hệ. 

Fụ, - động lực, hình thành trong khớp động thứ ì khi 
thực hiện chuyển động. 

q, - biến khớp (hoặc toạ độ suy rộng). 


{, - đạo hàm bậc nhất của biến khớp theo thời gian. 

Đồng thời khi mô tả vị trí tương đối giữa hai hệ toa độ thứ 1 và 
(i-L) dùng ma trận thuần nhất A,, hoặc viết đầy đủ hơn là ''A,. Dùng ma 
trận này có thể mô tả vị trí trạng thái trong hệ toa độ thứ ¡-I của một điểm 
bất kì thuộc hệ toa độ thứ 1. 

Các biến khớp q, hoặc còn gọi là toạ độ suy rộng là bộ các thông 
số dịch chuyển của các khớp động của robot. Vị trí trạng thái của điểm 
tác động cuối của robot hoàn toàn được xác định bởi bộ biến khớp q, này. 
Trong trường hợp khớp quay thì q, trùng với góc quay 9, của khớp, còn 
đối với khớp tịnh tiến thì q, trùng với độ tịnh tiến d, của khớp. 

8.2. VẬN TỐC VÀ GIA TỐC. 


Để xây dựng mô hình động lực học robor đùng phương trình 
Lagrange bậc 2, cần biết vân tốc của điểm bất kì trên tay máy. 


Điển M nào đó trong hệ toạ độ 1, xác định bằng vectơ mở rộng 'Tr,: 
tr=(X,Vs Z2. D (8.3) 

Kí hiệu 'r, có nghĩa là điểm M cho biết trong hệ toa độ ¡ và được 
biểu thị cũng trong hệ toa độ ¡. Còn khi dùng kí hiệu ”r, thì có nghĩa là 
điểm M cho biết trong hệ toạ độ ¡, nhưng được biểu thị trong hệ toa độ Xụ,. 
Vụ, Za, tức là trong hệ toa độ cơ bản. 

Như trước đây, dùng ma trận ''A, để mô tả vị trí tương đối giữa hệ 
toạ độ thứ ì đới với hệ toa độ thứ ¡-l và ma trận °“A, để mô tả quan hệ giữa 
hệ toạ độ thứ ì và hệ toa độ cơ bản. : 

Vậy quan hệ giữa ”r, và "'r, có thể biểu thị như sau: 

T.> An: (84) 
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với | „`... (8.5) 
Ma trận “`A, đã có từ biểu thức (4.11) 
Cụ —CgiŠo SuiSạ - AiCg 
Sạ, CajCac Su Cạc 85a, 
0 S_ C- d“ (S8 


ứI œŒ[ I 


0 0 0 | 


„` = 


Biểu thức (8.6) là viết cho trường hợp khớp quay 1, còn nếu khớp 
đông 1 là khớp tịnh tiến thì a, = Ö và từ (8.6) ta có: 
Cụ, — CS SuiŠo, 0 
` Sại CC; — Šu¡Cại 0 
wY S 2N. Kệ 


Đối với khớp quay thì ð, là biến khớp và đối với khớp tịnh tiến thì 
d, là biến khớp. 

Các phần tử khác không của ma trận ”A, đều là hàm của Ô, đ,. ơ, 
và a; (j = !,2,.... 0). Trong đó ơ, và a, lại là những thông số xác định bằng 
cấu trúc cụ thể của tay máy. Do vậy các phần tử này là hàm của biến 
khớp q, nói chung (q, = 9, đối với khớp quay và q, = d, đối với khớp tịnh 
tiến). 

Vị phàn biểu thức (§.4) với lưu ý rằng vectơ 'r, là không dối với hệ 
toa độ thứ ¡ vì giả thiết ràng các khâu của tày máy là vật rắn tuyệt đối, ta 
CÓ: 

1V = V, = đi ¬. 

đí dt 


=” Ả, A,.. AT.” A, LÁT Àj +. 
«+ Ác + ÁP, 


"ụ -lÖ am (8.8) 


Đạo hàm của ma trận '!A, đối với biến khớp q, có thể dễ đàng xác 
định theo công thức sau: 
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d'*A 


W 3... (89) 
Trong đó đối với khớp quay: 
[0 -—1 0 N 
II 0 0 0 
D,= " =-. (8.10) 
0 0 00, 
và đối với khớp tịnh tiến: 
l 0 0 0 
J0 000 
D, 8 "2219Ÿ đi (8.11) 
0 0 00 
Trong trường hợp L= 1, 2,..., na có: 
ô°A,_ ô 
ni TT... (#.12) 
J 1 


Trong các ma trận bên vế phải chí có À, phụ thuộc vào q,, do đó 
theo (£.9) ta có: 


ôẺ°A. dA. 
= ÄIÁ¿¡...A cụ =.. (8.13) 
öq, —đq; 
với D, tính theo (§.10) hoặc (8. l1). 
ô°A. 
c= AIA;...A DjA..Á (Ái (8.14) 
ôq; 


Phương trình (§. 14) mô tả sự thay đối vị trí các điểm cúa khâu thứ 
¡ gây nên bởi sự chuyển dịch của khớp động thứ j. 


Kí hiệu vế trái của (8.14) là U, và đơn giản hoá cách viết (8.14) 
như sau: ` 
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(8.15) 


Vậy cởng thức (7.8) có thể viết lại là: 


V,= tua, 'Py, 8.16) 


kE 


Tiếp theo, từ biểu thức (7.8) xác định gia tốc: 


8.3. ĐỘNG NĂNG TAY MÁY. “ˆ 
Kí hiệu K, là động năng của khâu ¡ (i=l, 2..... n; và đK, là động 
nàng cua một chất điểm khối lượng dm thuộc khâu ¡: 
ba : l 
dK, =6, +ý; +?7)dm =2 Tr(V,V/)dm (8.18) 
Trong đó Tr là vết của ma trận: 
TrA =4, 
1ml 


Thay vào (7.18) biểu thức (7.16) đối với V, tá có: 


Ẵ 
z vš mì z 
dK, c ⁄mš 0,4r|š U,AP | lo " 


= kT: » £ Uy rU7A,4, lim = 


Ln=lr=l (8.19) 


= báu >>U¿( rdmr, )U74,4, | 

Như đã nói ở trên ma trận U, biểu thị sự thay đổi vị trí của các 
điểm thuộc khâu ¡ gây nên bởi sự chuyên dịch của khớp động j. Ma trận 
này đều như nhau ở mọi điểm thuộc khâu ¡ và không phụ thuộc vào sự 
phân bố khối tượng trên khâu 1, tức là không phụ thuộc vào dm. Cũng 
vậy, đạo hàm của biến khớp q, theo thời gian không phụ thuộc vào dm. 
Do vậy ta :ó: 
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p~Lr=] 

Phản trong ngoặc đơn là ma trận quần tính J, của khâu ¡: 
[x¿dm [x,y,am Jx,z:ảm [x.dm | 
[xiy,.dm Jy/dm [yz,dm [y,dm 
[x,z,ám Íy.z.ảm [z?dm [z,ảm : 

L [k.ảm Íy.dm z.dm dm 


Nếu dùng Tenso quán tính I,: 


J,= [ri am = (8.21) 


HỆ JB.Exixx,bm (8.22) 


với các chỉ số ¡, J, k lấy lần lượt bằng các giá trị x, y„ z„ đó là các trục 
của hệ toa độ ¡, và ö, là kí hiệu Cronecke, thì ma trận J, có thể biểu thị ở 
dạng sau: 


L=E, XU To. | Ĩ s 
2 xy XZ m%X 
Ị kL HT L c 
&b _ „=.. ý Ÿ 
J,= 2 & (8.23) 
i lR  xP T 
s —— Ị 
+ # 2 HỆ 
m1 my m7 m 


Ở đây 'T, =(X,,},.Z, J)” - bán kính vectơ biểu diễn trọng tâm 
của khâu thứ ¡ trong hệ toạ độ ¡. Công thức (8.23) viết thành: 


-kñ,+k„+kệ : _ Ẹ 
- = : Kị; ky % 
J=m S 2 ¬.~-)...... 
3 2 2S ca h =. 
Kha Kộ; Ku tRø Rõ 2 
: 2 
X Ÿ, ' lộ 
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Ở đây K„ =l„/m, vàj= I,2,3;k= 1,2,3 

'r, =(X,.y,,3,,)“ - bán kính véctơ biểu diễn trọng tâm của khâu 
thứ ! trong hệ toa độ 1. 

Vậy, động năng của toàn cơ cấu tay máy bằng tổng đại số động 


năng của các khâu động: 


K=ŠK,= ⁄4ŸT >€U,1.Ura q,|= 
i=Ì : 2= p=l r=l L pr 


n1 Ì (§.25) 
T\y» 
= >> >[Tr(U,!,U; 4,4, 
Lưu ý rằng. các ma trận J, ( = l, 2...... n) chỉ phụ thuộc vào sự 


phân bố khối lượng của khâu ¡ trong hệ toạ độ ¡ mà không phụ thuộc vào 
vị trí và vận tốc. Vì thế cần tính ma trận ], chỉ một lần. 


8.4. THẾ NĂNG TAY MÁY. 
Thế năng P, của khâu ï: 
P,= -m,#”T,= - m, gø “A,'r,) (8.26) 
I=l,2,...n 
Trong đó 


'r, và  r, - bán kính vectơ biểu diễn trọng tâm của khâu ¡ 
* trong bệ toa độ cơ bản. 


ÿ - VCCIƠ gia tốc trọng trường, g = (0, 0, -g, O) (gia tốc 
trọng trường g = 9,8062 m/š”). 


Thế năng của toàn cơ cấu n khâu động: 


P= 


T2 


? 
ñ, ==3m,gÖ A,Y,). (8.27) 
8.5. MÔ HÌNH ĐÔNG LỰC HỌC TAY MÁY. 
Để xây đựng mô hình động lực học tay máy dùng phương trình 


Lagrange bậc 2 (phương trình 8.[): 


—(=—)- —EHụ § ï =l2....n 
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Phương trình trên cho biếu thức tính động lực F¿„. Đó là lực hoặc 
mômen tạo nên bởi nguồn động lực ở khớp động 1 để thực hiện chuyển 
động của khâu ¡. 


Thay (§.25), (8.27) vào (§.E), cuối cùng ta có: 


"I "j 1 u 
Fữ, = xà (U,„J.U; X\, SP là 2 TrU 1U,Myậy ->mgU, T, 


tr: k=l m=Ï Nói, °jt (5.28) 
Ị =12...n 
Biểu thức (8.28) có thể viết gọn lại như sau: 
n "1 "1 
Fụ, = >Ð„g, tà, > h¡„đ,4„ +C, (8.29) 
hoạc là dưới dạng ma trận: 

F¿ = D(q).d + h(q,4) + c(q) a4 30) 

Trong đó: 
.„/1) - wectơ (nx1) lực động, tạo nên ở n khớp động: 

Eu(Ð =[Ru(O,B;(Ó,...Fu¿ (ĐỊ (8.31) 
q() - vectơ (nx1) biến khớp: 

qŒ) =[q,(0,q;(9,...q„(Đ]” (8.32) 
đ (L) - vectơ (nx 1) tốc độ thay đối biến khớp: 

ä( =[4.(9,8; (9,...4„ (ĐỂ Q.33) 
g0) - vectơ (nx L) gia tốc biến khớp: 

q() =Ía,(Ð,8;(0....—„(ĐƑ tả.34) 
D(q) - ma trận (nxn), có các phần tử D„ sau đây: 
D¿,= 3 TrU,J,Uj) ¡k=I1,2,..n (8.35) 


Ƒmax(,k) 
h(q, ¿ ) - vectơ (nx L) lực ly tâm và Coriolit 


h(4. 4) = (h › h, xớng h„ là 
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hị = *, ¬"... I = I,2....,'8 (8.36) 


h„„= » TrU,ujU;,) ¡ikm=l2...n (8.37) 


km” J “ J 
J)E=nmMA((,kam) 3 ; b : 


c(q) - vectơ (nx l) lực trọng trường. 


c(q) = (C¡,Cz,...€„)ˆ 
H ĐỘ (3.38) 
ST >(_m,8U ,T ) 
IEL 


8.6 CÁC PHƯƠNG TRÌNH ĐỘNG LỤC HỌC CƠ CẤU TAY 
MÁY TOÀN KHỚP QUAY. 
Trong phần này tiến hành cụ thể hoá các biểu thức từ (8.30) đến 
(8.38) cho trường hợp cơ cấu tay máy 6 bậc tự do toàn khớp quay. Ở đây 
các biến khớp q, đều bằng 6,. 


Mu trận D(6) - xuất phát từ (8.35). ta có: 


Dị, Dị; DĐ; Dụ, Dị; Dị, 

D, D, D„, D,„ Du Dự 

6= D, D„; D,, D,, D, D, 
D(0)= (8.39) 

DỊ, Đụ, Dịụ Dụ, D,, D„ 

D, D, D, D, D, Dự, 

Dự, D„ D, Dự, D., Dự„ 


D,, =Tr(U,,1J,U)+ Tr(U;,J,U;,)+Tr(U,,J,Úi,)+Tr(U,,J,U?.)+ 
+Tr(U;,J;U;,)+Tr(U,J,U¿) 

D,, =D„, = Tr(U,;J;U3,)+Tr(U;,J,U?,)+Tr(U„J,U?,)+ 
+Tr(U,;J,U¿,)+Tr(U,;J,U,) 

D„; =D¿ =Tr(U;J;Uï,)+Tr(U,;jJ,U¿,)+ Tr(U,J;U¿,)+ 
+Ti(U,;J„U,), 

Dị, =D„¡ =Tr(U,,J,U¿,)+ Tr(U,„J;U¿,)+ Tr(U,„J,U¿,) 

Dụ, =D,, =Tr(U,,J,U¿)+ Tr(U,„J,Ua, ) 
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D„=D„ =Tr(U„J,UƑ) 

D,. = Tr(U,„J,UY.)+ Tr(U,2J,UE)+ Tr(U¿.J,UE,) + TrcŨ,.J;U;.) + 
+Tr(U,.J,U¿.) 

D.. = Ð., = Tr(U,;J,U}.)+ TrcU,J,U72)+ Tr(U,JUE)+ 
~TnU,jJ,UT) 

D,.=D„ = Tr(U,J,U?)+ Tr(U,„J.U},) +TrcU,„J,U¿.) 

D,,; =D,, = Tr(U,.J,U;.)+ Tr(U,„J,U¿-) 

D„ =D¿„ = Tr(U/„J,„U2.) 

D.. = Tr(U,.J,.U?,) + Tr(U,.J,UƑ) + TrCU,,J,U)+ Tr(U,.J,U2) 

D,, =D,. = Tr(U,,J,U7.)+ Tr(U.,J,U¿,)+Tr(U, J,U2.) 

D,, = D,; = Tr(U,,J;U¿,) + Tr(U,.JUC,) 

D„ = Dạ; = TU J,U2) 

D„„ = Tr(U,.J,U2,)+ Tr(U,„J,U¿,)+ Tr(U,„J,U},) 

D„, = D,, = Tr(U,„jJ,U¿,) + Tr(U,;J,U),) 

D„= D¿„ =Tr(U,J,U,) 

D,, = Tr(U,.J,U7,) +Tr(U,.J,UƑ,) 

Du = Du, = Tr(U,„J,U/,) 

D„ =Tr(U,„J,U¿.). 


G 


Vectơ h(6, Ø) - Các hệ số h„„ trong các biểu thức (8:36) và (8.37), 
có thể sắp xếp thành ma trận H,, sau đây: 


Hạ, h;ị; hạ; hạ hạ, hạ 
Hạ; h;›; h,; (24 ¡235 h;„„ 
H.-= hạ; hụ; hạ; h,;„ hạ; hịw ÍẰ@ E6 
n hụa hạ, hị¿ hạ, LỆ hị„ —=" Ki tp) 
hạ; h;;; hịy; h,„ h,;; h;s 
h,„ h;„ hị¿ hị„ h;z LỆ 


Tương tự (Š.33), ta viết: 
ô() = [ô(),ð;()....ð,(ĐÏ:. - (4D 


Dùng (8.40) và (8.4L), có thể biểu thị (5.36) ở dạng ma trận: 
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ñ: H50 lý + dc] xớ6ổ (8.42) 


Như vậy vectơ h((8, Ø } được biểu thị ơ dạng sau: 


[h] [ð'H,ð) 

h,' |Ö'H, Ô 

"..- ö'H,ô 
h(9,0) = h, vn Ô"H,.Ô (®w.43) 

h¿ Ô'H,.ô 

Lhụ 9 `H,,ð | 


Vectơ c(8) trên cơ sở (&.38), ta có: 
€(DYS (6,02ve:s6,6s;ex)” (*.44) 
Gị= ~mgU D +m gU) F.* m gU) F +m gU) + m gƯ, tẻ 
+m, gƯ, ) 
@Ẽ ¬m gU T, M mgU T, ° mg, + m gU  F T m gU, F.) 
kêu -(m gUt T + m gU; + m gƯ ss + m gU_ MP (R.45) 
c,=-{m,gU#, +m,gLUf/e +m,pUệ#,) 


c; =—{m.pU).t, + m„pU§.r ) 


Cœ = —m,gU,,. 


Các hệ số D,, h„„ và c, trong các biểu thúc (X.35) + (%.38) là hàm 
của biến khớp và của các thông số động lực học cơ cấu tay máy, cho nên 
gọi chúng là các hệ số động lực của tay máy. Ý nghĩa vật lý của các hệ số 
này có thể điền giải như sau: 

1) Các hệ số c, xác định từ (Š.38) biểu thị trọng lực tác dụng lên ` 
từng khâu của cơ cấu tay máy. 

2) Các hệ số Ð„ xác định từ (835), biếu thị các quan hệ giữa động 
lực với các gia tốc biến khớp. Trong trường hợp ¡=k, hệ số D, biển thị 
quan hệ giữa lực động Fạ¿„ tạo nên ở khớp ¡ với gia tốc biển khớp ¡. Còn 
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khi í#k, thì hệ số D„ biểu thị quan hệ giữa lực động Fụ, tạo nên ở khớp ¡ 
với pia tốc biến khớp K. 

Bởi vì ma trận quán tính là đối xứng và Tr(A) = Tr(A”), cho nên 
Dy, = Dự, ' 


3) Các hệ số h„„ xác định từ (8.36) và (#37), biểu thị các quan hệ 
giữa lực động với tốc độ thay đổi giá trị biến khớp. Ngoài ra hệ số hạ.„ 
còn biểu thị quan hệ giữa lực động, tạo nên ở khớp ¡, với tốc độ thay đổi 
biến khớp k và m. 


Khí tính toán các hệ số này nên lưu ý rằng ở những trường hợp 
sau đây sẽ có các hệ số bằng 0: 


1) Trong một số sơ đề cơ cấu cụ thể của tay máy có thể loại trừ 
các ảnh hưởng lẫn nhau của lực động giữa các khớp (các hệ số D,, hạ„). 


2) Một số giá trị của các hệ số h„„ tuy có mặt đanh nghĩa trong 
các biểu thức (8.36) và (8.37), nhưng thực tế là bằng 0. Ví dụ, hê số h„ 


luôn luôn bằng O, bởi vì lực ly tâm tạo ra do sự chuyển dịch của khớp ¡ thì 
không ảnh hưởng trực tiếp đến lực trong khớp ! nữa. 


3) Một số hệ số động lực của tay máy, ở một vài thời điểm nào đó 
có khi thay đổi cấu hình tay máy, có thể lấy bằng 0. 


Các phương trình động lực (8.30) là những phương trình vi phân 
phi tuyến bậc hai. Các phương trình trên có thể vận dụng để giải quyết ` 
các nhiệm vụ sau đây: 


Khi biết lực động Fụ, ở từng khớp và từng thời điển, trên cơ sở các 
phương trình động lực nói vẻ nguyên tác có thể tìm ra quy luật thay đối 
các giá trị biến khớp q(Ð) theo thời gian. Rồi tiếp theo đó, từ bộ giá trị q(t) 
sẽ xác định được quy luật thay đổi theo thời gian của vị trí bàn kẹp tức là 
xác định được quỹ đạo chuyển động của bàn kẹp. 


Ngược lại, nếu cho biết chương trình chuyển động, tức là cho biết 
q() và các đạo hàm bậc nhất, bậc 2 theo thời gian của q(), trèn cơ sở các 
phương trình động lực nói trên có thể xác định Fu, tác động lên từng khớp 
động ở các thời điểm khác nhau. 


Từ phương trình động lực (8.30) có thể xây dựng phương trình 
trạng thái điều khiển hệ thống robot có các liên hệ phản hỏi. Trên cơ sở 
đó có thể chọn lựa các quy luật điều khiển thường gặp sao cho giảm thiểu 
các ảnh hưởng phi tuyến tác động lên rhau của các nguồn động lực trong 
các khớp động. 
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8.7. ĐỘNG LỰC HỌC CỦA CƠ CẤU TAY MÁY 2 KHÂU. 

Trong phần này dẫn ra ví dụ mính hoạ việc xây dựng mô hình 
động lực học của cơ cấu tay máy 2 khâu toàn khớp quay (hình &§. |). 

Như đã chỉ trên hình 8.L các trục Z, đều trùng phương với các trục 
quay khớp động. Khối lượng của các khâu tương ứng là m;, m;; Bộ thông 
số DH của tay máy phi trong bảng sau: 


l [ T TT Tì 
Í_Khau | 8 Ị & đ, Khới 
| —T† 1 | Œœ_, 4 P 
Ị 6 | 0Ô ị 06 | R 
T ] 
2 bÀ | 0 L | 0 R 


Hình 8.l_ Cơ cấu taụ máy 2 khâu 


Các ma trận "'A, (¡ = 1, 2) sẽ là: 


CÔ §, 01C, =0: 4E: 
sạ lộc Có 01, lA,„[Ÿ Có 0 8: 
0 0 1 0 0 0 10 
0 0 0 1 00 0 1 
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Ú”" 11+) 
: _. `... ẽ... 
A:=`A, A;¿= I 0 
0 0 0 | 
Vẫn như trước đây dùng các kí hiệu sau: 
C=cos8,; S5 =sin68,; C,= cos (Ô,+Ð); S¡= sin(0, + 6). 


Theo (.|Š), ta có: 


0 -1 0 Nin 8, 01C, 
ô°A | 0 0|IS5 CC 0 1S 
U,, '=D,A,= - LÌ= 
9, 0 0 0 010 0 I! 0 
0 0 0:0 0 0 1 
_§, =C, 0 —1§, 
=|C, -S§, 0 +IC, 
0 0 0 0 
L0 0 0 0 
Tương tự, đối với Ù;, và U¿;: 

0 -1 0 0j[C, -S, 0 lC„,+C,) 
ô°A I1 0 00 |S. CC. 0 lS,+S 
U;,= 2 =D,°A,= l2 2 ( 12 ) = 
Ø, 0 0 00 0 1 0 
0 0 0 0|10 0 0 1 

—Š%; CC, 0 — IS; +8.) 
C, —8; 0 +I(C/;+CŒ,) 
0 00 0 
0 0 0 0 


211 


G:-§ 0/IGT[G zÍ ð 6|lf© <5; 0 K] 

nã ca 

F2 o0 010llo000ll0 0101. 
lên vì nên hi 1 

`“: `... 

ộ, -a§) 40: AC, 

0 0 0 0 

L 0 0 0Ô 0 


Theo (8.23) và giả thiết cả các thành phần mômen ly tâm quán 
tính đều bằng 0, ta có: 


1/312 0 0 —-l/2m! 1/3!” 0 0 ~U2m.l 
0 00 0 000 0 
= J; = 
0D 00 0 


—U2mj} 0 0 mm 


0 00 0 
|2» ¡ 0 0 


Trên cơ sở (8.35), ta có: 


D, =T,(U,J,U1)+T,(U;,J,U2,)= 


—§, —C, 0 -l§,| j1/3m/l 0 0 -1/2m, 
€C, ~— 0 1C l 
=T, : h : : 0 0 0 0 U? + 
0 0 0 0 
0 0 0 0 -l/2m,l 0 0 m¿ 
=8; =Cj¿ 0 -lQj, +C,) 
+T; Cạ Šị; 0 l(C; +C,) * 
0 00 0 
0 0 09 0 


1/3m, 0 0 -1/2m,l 
0 0 0 0 
0 0 0 0 
-l/2m.l 0 0 m; 


2+ =1/3m,1° +4/3m,]” +m,C,I? 
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D,, =D,, =Tr(U,,J;U?.)= 


[=S; -C„ 0 -R¿,] [13m1 0 0 -1/2m, 
ft Cụ; —Š; 0 1C; 0 0 0 Ũ UT 
0 0 0 0 0 0 0 0 š 
0 0D 0 0 —l/2m.l 0 0 m; 


=m,l2(~1/6+1/2+1/2C,)=1/3m,!? +1/2m,l? 


D„; =Tr(U,;J;U;,) K= 


_8;, Cụ, 0 Thụ 1/3m.lẺ 0 0 ~1/2m;l 
<1 GœG, -5, 01C, 0 0 0 0 UP La 
0 0 0 l) 0 0 0 0 
0 00 0 -1/2m.l 0 0 m, 


=1/3m.l 1S +1/3m,l°Cj, =1/3m,ŸẺ. 
Tính các số hạng trong biểu thức (8.36) đối với ¡ = l. (a có: 
3 2 
hị= Š` S h,„6,0, =h,,Ô,ô, +hujôyô, thịụyÕ) + hụyÔ) 
=Ììm- 


và theo (8.37) tính các hệ số h,„„„ rồi thay vào phương trình trên, (ta được: 


h,=—1/2m;S,16? -m,S,Iô,6,. 
Tương tự đối với 1 = 2 


` Š ch;u„Õ, Ô,„ =h;,,ð; +h,,,Ô,Ô, +h,„,Ô,Ô, +h¿„„Ö; = 


kzlun= 

= 2n /E0 l6" 
Như vậy: 

| Sản lề 
m m,S,lˆÖ; -m,S,lö,6, 


| 
h(9,Ô) =| 1 hy 
| mS;U6i 


Tiên cơ sở (8.38), ta có: 


= —(m,gUJ th + toà lên = 


0 _-IS,] [-1/2 

=— "m.- S, 0 1C, SN lộ 
0 0 0 0 
ọ 0c âu | 


0 1C ;+€/) 0 
0 0 0 
0 0 ì 
m;glC,; + m;slC,: 


C 
—m.(0-g,0,0)\| 
h 0 

| 0 
=1/2m,glC,+1/2m 


0 
0 
S¿ TC; Ô -l@®$;+§,)| [=U2 
=5 
) 
0 


C —m,gU?F, 
`"... 5. 
C 5 0 IC 
=. 0— ,0,0 12 12 lbì = 
PS ESUIÔN C7 cụ “0v +0 
0 0 0 0 | 


=m;(1/2glC;; — glC ¿ ). 


Vậy vectơ lực trọng trường sẽ là: 


l | 
“la —m,slC, 3 Tuy lesmsTE 
c(0) "| ì SE 2 
2 Du 
Cuối cùng ta có phương trình động lực học của cơ cấu tay máy 2 
khâu ở đạng sau: 
Fu„() = D(8)(Ö(t)+ h(6,6) + c(9) 
[Bạ, | |1/3m,1 +4/3m,! +mUC.IP 1/3m,l?+1/2m.2C, | [B, : 
Pp 1/3m,l? +1/2m,UC, 1/3m,l" Ổ, 
-1/2m,S,1ô3 - mui Đi, 
+ : : 339 : - hậh 
[ 1/2m,S.1'6; ] 
nì -1/2m.glC, —!/2m,glC,, +m,gIC, 
L 1/2m,gIC,. 
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CHƯƠNG IX 
ĐIỀU KHIỂN ROBOT 


9.1. KHÁI NIỆM CHUNG VỀ HỆ ĐIỀU KHIỂN TỰ ĐỘNG 


Hệ thống điều khiển tự động là hệ thống được xây dựng từ 3 bộ 
phận chủ yếu sau: 


- Thiết bị điều khiển C (controller). 
- Đối tượng điều khiển O (object). 
- Thiết bị đo lường M (measuring device). 


Đó là một hệ thống có phản hồi (feedback) hay có liên hệ ngược. 
Sơ đồ khối đơn giản nhất về hệ thống điều khiển tự động cho trên 
hình 9.1, 


lỗi E X 
—>§@À—>.c —>*o _-> vy 
VÁ É 
Hình 9.1. Sơ đồ đơn giản hệ thống điều khiển tự động 
Các tín hiệu tác động trong hệ thống: 
Ư - tín hiệu vào (nput). 
Y - tín hiệu ra (output). 
X - tín hiệu điều khiển tác động lén đối tượng O. 
E - sai lệch điều khiển. 


Z - tín hiệu phản hồi (phản hồi âm ký hiệu bằng dấu (-) khi Z 
ngược dấu với tín hiệu ). 


Thông thường có 3 nguyên tắc điều khiển cơ bản: 
- Nguyên tắc điều khiển theo độ sai lệch. 
- Nguyên tắc điều khiến theo phương pháp bù nhiễu. 
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- Nguyên tắc điều khiển hỗn hợp theo độ sai lệch và bù nhiễu. 
Trên hình 9.2 vẽ sơ đồ hệ thống điều khiển theo nguyên tắc hỗn 
hợp. Tín hiệu Y(t là tín hiệu ra, f(t) là nhiễu tác động vào đối tượng điều 
khiển. 


Hình 9.2. Sơ đồ hệ thống diều khiến hỗn hợp 


Nhiều f(0) tác động lên đối tượng điều khiển, ví dụ, theo chiều 
hướng làm tăng tín hiệu ra YŒ). Trong hệ có đưa vào một thiết bị bù K có 
tác dụng ngược dấu với f, nghĩa là V tác dụng bù về phía trước thiết bị 
điều khiển C để làm tín hiệu E giảm bớt. Nếu f tác dụng lên đối tượng 
điều khiển O để làm giảm tín hiệu ra Y() thì thiết bị bù K lại tạo ra tín 
hiệu bù V làm tăng E để làm tăng Y. 


Hệ thống điều khiển theo nguyên tắc hỗn hợp được dùng rộng rãi 
trong thực tế. 


Ngoài các nguyên tắc điều khiển cơ bản nói trên người ta còn ứng 
dụng các nguyên tắc khác như: 


- Nguyên tắc điều khiển theo chương trình. 
- Nguyên tắc điều khiển thích nghi. 


Ngày nay do sự phát triển nhanh chóng của kỹ thuật vi xử lý và vi tính 
người ta đã tống hợp ra các hệ điều khiến rất phức tạp, trong đó thiết bị 
điều khiển (controller) chính là một máy vị tính có thêm các thiết bị ghép 
phôi A/D (Analogue — Digital) và D/A (Digital — Analopue). Các thuật 
toán điều khiển được tính toán theo các phương pháp tối ưu và thích nghi. 
Đồng thời trong những năm gần đây đã xuất hiện nhiều công cụ phần 
mềm làm xúc tiến mạnh mẽ việc nghiên cứu phát triển các hệ thống điều 
khiển tự động. Trong đó cần kể đến MATLAB, đó là một công cụ phần 
mẻm của MathWsrks. Matlab được sử dụng trong nhiều lĩnh vực giảng 
dạy, nghiên cứu, thiết kế và triển khai các hệ thống điều khiển, từ hệ 
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thống điều khiển đơn giản đến các hệ thống điều khiển tổng hợp phức 
tạp. Matlab còn có các bộ chương trình chuyên dụng (gọi là tools box) 
phong phú, trong đó có một số chương trình chuyên dụng cho điều khiến 
tự động. 


Có nhiều cách phân loại các hệ thống điều khiển tự động. Thường 
có các hệ thống điều khiển sau: 


ĐHệ thống tuyến tính. 
2) Hệ thống phi tuyến tính. 


3) Hệ thống liên tục: khi các tín hiệu tác động trong hệ là hàm 
liên tục theo thời gian. 


4) Hệ thống rời rạc: trong đó chỉ cần có một tín hiệu là hàm rời 
rạc theo thời gian. 


5) Hệ thống tiền định là hệ thống trong đó tất cả các tín hiệu 
truyền là hàm theo thời gian xác định (không có tín hiệu ngẫu nhiên). 


6) Hệ thống ngẫu nhiên là hệ thống trong đó chỉ cần có I tín hiệu 
là hàm ngẫu nhiên. 


7) Hệ thống tối ưu là hệ thống điều khiển trong đó thiết bị điều 
khiển có chức năng tổng hợp được một tín hiệu điều khiển U(t) tác động 
lên đối tượng điều khiến để đạt một trạng thái tối ưu theo một chỉ tiêu nào 
đó. 

§) Hệ thống thích nghi hay còn gọi là hệ thống tự chỉnh là hệ 
thống có khả năng một cách tự động thích ứng với những biến đổi của 
điều kiện môi trường và đặc tính của đối tượng điều khiển bằng cách thay 
đổi tham số và cấu trúc sơ đồ của thiết bị điều khiến. 


Các hệ thống được phân loại trên đây có thể lại có nhiều mối liên 
quan với nhau. Ví dụ, trong hệ ngâu nhiên có thể là tuyến tính hoặc phi 
tuyến: trong hệ tuyến tính lại có thế là hệ liên tục hoặc rời rạc v.v... Do 
vậy có thể nói việc phân loại hệ thống điều khiến tự động hoàn tuần phụ 
thuộc vào mục đích phân loại. 


Trong kĩ thuật người máy người ta cũng phân hệ điều khiển ra: 

- Điều khiến chương trình: việc điều khiển được thực hiện theo 
một chương trình định sản. 

- Điều khiển thích nghí: việc điều khiển tuỳ thuộc vào thông tin 
nhận biết được trong quá trình làm việc về hiện trạng của môi trường 
thao tác và của bản thân người máy. 
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Hệ điều khiển thích nghi khi được phát triển ở mức độ cao, thực 
hiện được một số chức năng của trí óc con người, thì có thể gọi là người 
máy có hệ điều khiến tinh khôn. 


Tuỳ theo khả năng thực hiện các chuyên động của người máy mà 
chia thành các thiết bị điều khiến sau đáy: 


- Điều khiến theo chu tuyến: chuyển động được thực hiện theo 
một đường liên tục. 


- Điều khiển theo vị trí: chuyển động được đảm bảo qua một số vị 
trí nhất định. 


- Điều khiển theo chu kỳ: chuyển động được xác định bằng các vị 
trí đầu và cuối hành trình của mỗi bậc tự do. 


9.2. PHÉP BIẾN ĐỐI LAPLACE. 


Để dễ hình dung phép biến đổi Laplace so sánh nó với phép biển 
đối Logarit quen biết. Nếu phép biến đổi Logarit đã làm đơn giản hoá 
nhiều phép tính đại số (ví dụ, phép luỹ thừa bậc lẻ v.v...) thì phép biến đổi 
Laplace cũng có thể làm đơn giản hoá các cách giải phương trình vị phân. 
Phép biến đổi Laplace là công cụ, là cơ sở của một phương pháp giải 
phương trình vi phân tuyến tính hệ số cố định để xét các đặc tính ổn định 
và quá độ. Phép biến đổi Laplace chuyến phương trình vi phân tuyến tính 
thành phương trình đại số. Sau đó, các nghiệm của phương trình đại số 
này sẽ được biến đổi ngược để cho các nghiệm của phương trình vi phân 
đã cho. 


Phương trình chứa các đạo hàm theo thời gian t, được biến đốt 
thành phương trình đại số, trong đó xuất hiện biến số mới, biến số 
Laplace s. Biến số s là biến số độc lập thay cho thời gian t, tức là đã 
chuyển từ lĩnh vực thời gian sang lĩnh vực Laplace. Biến số s là biến số 
phức (s = Ø + j@ với ø và œ là số thực, j = Ý-]). 


Như vậy phép biến đổi Laplace dựa trên cơ sở thay thế các hàm 
biến thực (thường là thời gian) bằng một số quan hệ phụ thuộc tần số. 
Phương pháp này thường dùng làm cơ sở phân tích và thiết kế các hệ 
thống điều khiển tự động. 

Biến đối Laplace thuận là kết quả của một thuật toán chuyển đổi 
đối với hàm thời gian f(1) để cho ta hàm F(s) với biến số phức s. 


Gọi F(s) là biến đổi Laplace của f(t) khi: 
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T 
F(s) = Lf(Đ]= lim [fđe "di = 
t-»0 Ê 
= [te *át 
Ó 


Với O<£<T 
Hàm f(t) phản là hàm thực và liên tục suốt thời gian khảo sát từ O” 
đên +œ. 


Ví dụ: hàm e" là hàm có thể biến đốt Laplace được vì.: 


| Bị |e-“*dt = jE “hát = 
lu 0' 
| 
| : - | 
===__._—= (l>Øa)t BC < + 


Nếu 1 + ø >0 hoặc ơ, >-l 


Biến đổi Laplace của hàm e" là: 


ĩ —] | 
⁄Ồ ¿ = e *e “dĩ = ế th - = 
. ] s+Ï " g+] 


9.2.1. Các cặp biến đổi Laplace (thuận nghịch) thường gặp 


T ” f9 E@&) 
T 


| 
[| Hầm xung đơn vị Ị I 
2| Hàm bác thang đơn vị 1 
S 
3 kS 
3 
S 
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TỊ fụ F(s 
Ta ú) mở 
4 ị (ˆ g1 
| 5 e" =_= 
Ị s+a 
: n1 em” ] 
| s Đ : 
Ï (n—1} (s+a}) 
n- số nguyên đương 
ị ` (I-e*) _. 
s(s+a} 
1 Ì 
§ — (at-l+-aU — 
a" s”(s+a) 
1 
D) (" -e”) 
ba (s+aXs + b) 
LŨ Í H¿l/a b(b,e” -a,e ")] .... 
ab s. s(s + a Xs + b} 
l -aL -bhI R 
1l (be ˆ =ä€@ ) TT 
b-a (s+a Xs+b) 
| 
@ 
12 SIn @† › nh 
s“ +ơứ 
Š 
13 C0s đt "=- 
5s +) 
@T 
14 €”" sin @L 3 P 
(s+a) +oø” 
s+ta 
l) €” COS 001 hài VS Tác 
(s+a) +ø' 
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.0.2.2.Các tính chất của phép hiến đổi Laplacc: 


1. Tính chất tuyến tính: 
L[a f]= a. F(s) 
L' [b F(s)] = b. f(Œ) 


Trong đó L” - phép biến đổi Laplace nghịch. 


(È.2) 
-(93) 


2. Tính chất xếp chồng: 


L[f@ + (Ð] = Fi @) +E; (S) (9:4) 
L'[E,) # F;(s) = f,( +(Ð 49.5) 
Kết hợp cả 2 tính chất trên (1. và 2.) ta có: 
L {a,f,) + a;f;(Ð] = a/F,(s) + a;F;(s) (86) 
L` [b,F,s) + b„F:(s)] = b,f,(Ð + b„;@) @'.7) 
3. Vì phân: 
- Đạo hàm cấp Ì 
df() 2 : 
dt » 
Giá trị (0°) là giá trị f(Q) tại thời gian đầu. 
- Đạo hàm cấp 2 
đf@)| ; đf(0”) 
LÌ —>—|=s F@)—-sF(0ˆ°)-———— 9 
dt? dt c 
đ7ƒ(0”) 


E: là giá trị của đạo hàm cấp I tại thời điểm đầu. 


4. Tích phân: 


H Joal=R ĐÀ DI 


03, HÀM TRUYỀN VÀ SƠ ĐỒ CẤU TRÚC HỆ ĐIỀU 
KHIỂN 
943.1. Định nghĩa. 


Hàm truyền của hệ thống là tỷ số giữa tín hiểu ra với tín hiệu vào 
của hệ thống đó biểu diễn theo biến số Laplace khi các điều kiện đầu 
bằng không. 


[ro )dt 


R (5-10) 
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Hàm truyền được ký hiệu là W(@s) 


II 


W(s)= X@) (9.11) 


với  Y(s) - ảnh Laplace của tín hiệu ra. 
X(@s) - ảnh Laplace của tín hiệu vào. 
s - biến số Laplace (s = Ø + j @, với Ø và œ là các số thực, ¡ = TIÊN, 


Nếu x(Ð); y() là tín hiệu vào và tín hiệu ra của hệ thống trong lĩnh 
vực thời gian t, thì để xác định hàm truyền W(s) cần fìm ảnh của x(); y() 
trong lĩnh vực Laplace bằng cách dùng phép biến đối Laplace. 

Để xác định hàm truyền của một hệ thống nào đó người ta thường 
xuất phát từ phương trình vi phân mô tả hệ thống đó, rồi dùng phép biến 
đổi Laplace để tìm hàm truyền. 

Trong trường hợp tổng quát hệ thống được mỏ tả bằng phương 
trình vị phân sau: 


d"y d”°y d”x d”x 
Ân cm Tây, Tiên ESPRIDh  ] BẾP mà Hư To ĐX (312) 
hoặc 

N..... ... 
38,——= b—— P 
3 ' đủ 3 ' dự (9.13) 


Dùng phép biến đổi Laplace của đạo hàm cấp n. 
d"*£(0* ) 
dị" 


Sau khi biến đổi Laplace phương trình vì phân trên khi các điều 
kiện đầu bằng không, ta có: 


đ°f@) Nẻ h2 2 
Lạc Da cua 6.19 


`... 2„bi 
bê c7 007 TP mén (9.15) 
an : 
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tức la: 
b„s”+bu 60 + +bố 


= Ọ, 
là cò tin) 


W@) = 
a,s"+b,.,S 


Khi W&@) có dạng tích số các phân thức bậc nhất s ở mẫu số: 


“GÌ Y(s) : 
W(s) Kiên “Y@) (9.17) 


thì sơ đồ trạng thái biểu điền hàm truyền (9.17) vẽ trên hình 9.3 


Hình 9.3. Sơ đồ trạng thái ứng uới biểu thức (3.17) 
Khi hàm truyền cố thể khai triển thành tổng các phân thức đơn 


giản: 
6n ng T7 &.® 
Hay: 
» Gánn = F(s) (9:19) 
Đặt: X,(s)= — (920) 
thì: Ÿ()= >GX (s) (921) 


Theo đó có sơ đề trạng thái trên hình 8.4. Trên đó X, (ï¡ = 1,2...n) 
là các biến trạng thái, còn Ÿ, (¡ = 1,2, ... n) là các biến ra. 
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Hình 9.4. Sơ đồ trạng thải ứng uới biểu thức (0.21) 


9.3.2 Phương pháp biến đồi sơ đô cấu trúc 
1) Nối tiếp các khối: 
Có n khối nối tiếp nhau tương ứng với các hàm truyền 


W,, W;... W, thì hàm truyền tương đương sẽ bằng (ích của n hàm truyền 
thành phần. 


X X; y x X 
w W⁄ _ W, W W2 ....M» 


Hình 9-5. Nối tiếp các khối 
Thật vậy, từ hình 9.5 ta có: 


_*i 
ho % 
w -Š: w== 
=. SP 
W=Y, 
X 
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Rõ rằng ta có ngay: 


W,W,..W, =] [W,EW 


(9.22) 


2) Nối song song các khối. 


Có n khối song song thì hàm truyền tương đương sẽ bằng tổng các 
hàm truyền thành phần. 


Hình 9.6. Nối song song 
Thật vậy, từ hình Ổ.6 ta có: 


YX=WX 
Y=WX : và Y=Y+Y+..+V 
BA Y.+V+..+Y =W+W+..+W) 
Y= 
Y ` à 
- VẬY: W=ssWj+W+ao†W.=Ð Mi (9.23) 


=l 
3) Hai khốt nối ngược chiêu (phản hồi) 
Xét hệ thống có liên hệ phản hồi, trên hình 9.7 ghi đấu trừ (-) 
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Y=We 
Z=W,Y 
Hình 9.7. Hơi khối nối ngược chiều 
Giải ra tả CÓ: 
_ Y kệ W, 
X 1+ W, W, (9.24) 
Nếu hệ thống có phản hồi dương thì 
ce=X+1Z 
Y W 
r2: W=—=_—_—'! l35 
là X I-W,W, ky: 


4) Chuyển tín hiệu vào từ trước ra xa một khối 


Điều kiện biến đổi cấu trúc là tín hiệu truyền không biến đổi. Trên 
hình 9.8 phải có X, Z và Y không đổi. 


Hinh 9.8. Chuyển tín hiệu uào từ trước ra sau 


Từ hình 8.8a ta có: 
Y=(X+Z)WE=WX+WZ 

Từ hình 8.8b ta có: 
Y=Y,+Y,=WX+WZ 


Rõ ràng tín hiệu Z, chuyển từ trước ra sau một khối, tín hiệu đó 
phải đi qua một khối mới, đúng bằng khối đó. 
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- 
- 


5) Chuyển tín hiệu vào từ sau ra trước một khối. 


Hinh 9.9, Chuuến tín hiệu uảo từ sau ra trước 


6) Chuyển tín liệu ra từ san ra trước một khối 


Hình 9.10. Chuyến tín hiệu ra từ sau ra trước 


7) Cluyển tín hiệu ra tỲ rước ra van mội khốt 


Hình 9.11. Chuyển tín hiệu ra từ trước ra sau 


8) Hoán vị 2 tín hiệu vào (hoặc 2 tín hiệu ra) với nhan thì sơ đỏ 
không thay đối 


Lếi Si 


Hình 9.12. Hoán uị 2 tín hiệu 


Sàn, 


Ví dụ: 
Xét hệ thống có sơ đồ cấu trúc như hình 9.13. Muốn đơn giản sơ 
đồ cấu trúc hình 9.13, phải dịch chuyển tín hiệu ra giữa 2 khối W, - W, ra 
trước khối W; (hình 9. 14): 


Hai tín hiệu ra từ A và B có thể hoán vị cho nhau khi đó mạch 
vòng W, - W, - W¿ có thể thay tương đương bằng W,, (phản hồi đương): 


W 
W\ = ——— 
I_W,W,W, 
Do đó ta có sơ đồ cấu trúc mới trên hình 8.15. 


Từ sơ đồ hình[Ä.15 mạch vòng W, - W,, - W; (phản hồi am) có thể 
thay tương đương bằng WQ: 


(9.26) 


"... 
2 1+W,W,W, 


Do đó có sơ đồ cấu trúc mới trên hình 9.16, 


(9.27) 


Cuối cùng có thể tính được hàm truyền của cả hệ thống là: 
= W„W, W, l § 
l+W,,W,W, NGÙi 


Hình 18. Ví dụ sơ đồ cấu trúc 
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Hình g.15. Thay W; - W¿ - W¿ tương đương bằng t; 


x 
kở lu: F- ấ, : 


Hình 9.16. Thay W, - W;; - Wạ tương ứng bằng WU„¿ 


9.4. HÀM TRUYỀN TẤN SỐ VÀ ĐẶC TÍNH TẤN SỐ. 

Trong lý thuyết điều khiển tự động người ta còn sử dụng rộng ‹ãi 
hàm truyền tần số (hay là ham truyền phức). Hàm truyền tần số là tỷ số 
giữa tín hiệu ra và tín hiệu vào của hệ thống khi đầu vào biến đổi theo 
quy luật điều hoà với tần số thay đổi từ O đến œ. 

Nếu tín hiệu vào X =X„ sin @t (9.29) 

Tín hiệu ra là y = y„ SI (@t + @) : (9.30) 


Có thể biểu điển bằng phức số: 
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- Đối với tín hiệu vào: 


x(Ù= X„ sin@t —> xe?” 


đx : Hị : lí | 
—— =X„@SIN@1 + —) —> J2).X.„.€ 
dt 2 


¬ 


(9.31) 


k 7 = (3 
c =X„@ sin(@t+ 2— ->(J@) xe 
đtíˆ 2 


- Đối với tín hiệu ra: 


yữ) = Tụ sin(ø + @) _— TT, Dài, 


+ 7 + MJ Tự, 
các }„@sin(øf + @+—) — /a@.v„ e me) : 
đi 2 (9.32) 


2 
Y 2:14 7 S5 Vố (vớ) 
=1 = y„@ sin(a + ø+ 2—- ~> /@) ) lu 


- Nếu một hệ thống đơn giản được mô tả bởi phương trình ví phân 
bậc 2: 


Uˆ (3.33) 


thì khí thay vào phương trình vi phần này các biếu thúc phức số 431), 
(9.32) tín hiệu vào và ra ở trên ta CÓ: 


| 2(J@) † a,(@)+a ly ÊUEBLIBI 
(h ) ‡ J + ] 4 9 14 


Ký hiệu hàm truyền tần số là W(ø): 


W(je)= 2e" 


m 


(9.35) 
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_ b,(j@)” + b,(1@)+ bụ 


W(@@) và s2 
a;(J@)ˆ +a,Cj@) +au 


(9,36) 


Suy từ (9. 16) theo phương trình ví phân (Ở.33) ta có hàm truyền: 


2 

W(s) = Bế + Ðbis + bọ ồ ¬ 
a;S” +ais tao ' 

So sánh (9.36) và (0.37) có nhận xét sau: làm truyền tân số có 
thể được xác định từ hàm truyền trone lĩnh vực Laplace bằng cách thay 
biển số phức x bằng biến số do (/@). Việc thay thế có vẻ rất hình thức này 
được giải thích rõ về mặt vật lý qua ví dụ ở trên. 

Sử dụng hàm truyền tần số và phương pháp phân tích tần số cho 
phép chúng ta có thể đánh giá và điểu chính được các tính năng cúa hệ 
thống mà không cần giải phương trình vĩ phân. 


~- Nếu viết hàm truyền tần số đưới dạng biên độ pha: 
W(7ø) = A(u)e (9.38) 


trong đó A(@) là biên độ của W(m), còn @ (@) là pha của W(o) thì từ 
biểu thức 9.36, ta có: 


: V(bạ ~b¿@ˆ)ˆ +(b,@)Ÿ 


A(œ) : 5 9.39 
\(a¿ =a,@”)) +(a,@)Ÿ b ) 
b,@ ai@ 
((0)) = aTCtĐ x~ — arctg : (9.40) 
gmD;@ as,—=a;œ 
- Nếu viết WQ@) đưới dạng phần thực và áo thì: * 
W(J@ø) = P(øœ + JQ(6) (9H) 


Trong đó: P(@) là phần thực của W(@o). 
Q(@) là phần áo của W(ø). 

Hàm truyền tần số W(j@) được biểu diễn thành một đường cong 
trên mặt phăng phức và gọi là đặc tính tần số biên đô pha (viết tất là 
ĐTBP). ĐTBP gồm 2 nhánh đối xứng qua trục hoành. Thông thường 
người ta chị quan tâm nhánh ứng với œ > Ô (hình Ð. 17). 


[x2 
. 


Hình Ö.17. Đặc tính tần số biên 
độ pha (ĐTBP) 


Trên hình 9.18a và 9,L8b xây dựng đặc tính tần số biên độ — A(ø) 
và đặc tính tần số — pha (@ (œ). Trên hình 9.I8c và 9.18d xây dựng đặc, 
tính tần số — phần thực P(@) và tần số — phần áo Q(@). 

Vì A(@) và P(œ) là hàm chắn nên đường đặc tính đối xứng qua 
trục tung, còn @(@) và Q(œ) là hàm lẻ nên đường đặc tính đối xứng qua 
gốc toa độ. 


Hình 9.18. Cóc đường đặc tính 


Nếu biết các đặc tính P() và Q(œ) xác định A(@) và @(œ) theo 
các công thức sau: 


A(®) =+JP?(@)+Q?(e) (942) 
z Q(œ) 
(0(œ@) = SH TÊ nu, Ø8) 


Đặc tính tần số biên độ pha thường được biểu diễn theo tỷ lệ xích 
loganit. Nếu lấy logarit 2 vế của (9.38) ta có: 


In W(J@) = In A(@) + J@(@) (9.44) 
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Biểu thức: (2) = In Á(ø) (9.45) 


được gọi là đặc tính tần số biên độ logarit (ĐTBL). Đặc tính tân số biến 
độ iogarit thường được biểu điễn ở dạng: 


L{œ) = 201n A(ø} (9.46) 


Trục tung đặc L(@) theo đơn vị decibel (viết tắt là đB). còn trục 
hoành thuận lợi nhất là theo lg(@). 


9,5. HÀM TRUYỀN CHUYỂN ĐỘNG MỖI KHỚP ĐÔNG 


Trong phần này trình bày phương pháp xây dựng hàm truyền đối 
với trường hợp chuyển động 1 bậc tự do. Trong cơ cấu tay máy mỗi bậc 
tự do thường được điều khiển bằng một hệ truyền động riêng. Truyền 
động có thể là thuỷ lực, khí nén nhưng nhiều hơn cả là bằng đông cơ điện 
một chiều. 


Trên hình 9.19 là sơ đồ động cơ điện một chiều với tín hiệu vào là 


điện áp U, đặt vào phần ứng, tín hiệu ra là góc quay 9, của trục động cơ, 
kích từ cho động cơ là kích từ độc lập. 


Hình 9.19. Sơ đồ oới đông cơ điện một chiều 


Trục động cơ thường nối liền với hộp giảm tốc (hình 9.20) rồi tới 
trục phụ tải. Gọi n là tỷ số truyền, Ð, là góc quay của trục phụ tải. ta có: 


6, (O =nÔ,(Ð] 
,(0 = nộ „() 
ñ,() = nỗ Œ) 


(9.47) 


Mômen trên trục động cơ bàng tổng mômen cần để động cơ quay 
công với mômen phụ tải quy về trục động cơ. 


MŒ)=M„()+M/@) (9.48) 
Kỹ hiệu J„ - mômen quán tính của động cơ 
J - mỏmen quan tính phụ tải 
ta CỐ: 
M„Œ)=1,ð.(@)+f 9) (9.49) 
M,Œ)=1,ỗñ,(@)+f4Ð,@) (9.50) 


trong đó f„ và f, là hệ số cản của động cơ và của phụ tải. 


Hình 9.20, Sơ đổ đông cơ điện cùng phụ tái 


Theo định luật báo toàn năng lượng, công do phụ tải sinh ra tính 
trên trực phụ tải là M, 9, phải bằng công quy về trục động cơ M, '9.,. Từ 
đó ta có: 

: M,(9,() - 
M,()= Ề - =nM,(0) 9SỊ 
L 0„ @) L, (2.51) 


Tính tới (9 47) và (9.50) tạ có: 


Mi()=n”[J,Õ„(0 + f6» @)J Dư: 
Thay (9.49) và @0.52) vào (2-18) 1à có: 


M@) = (1, là nỉ kiỂn () + (Í, + fb› lÖ„@) 


M(@) =JÖö„()Q+fÖ() (9.53) 
với J=1„+n1, 
f=f„+ní, 


1T 
Trong đó: J - mômen quán tính tống hiệu dụng 
E - hệ số tổng hiệu dụng. 


Bởi vì mômen trên trục động cơ phụ thuộc tuyến tính với cường 
độ dòng điện phần ứng và không phụ thuộc vào póc quay và vận tốc góc, 
†a CỐ: 


MŒ)=K„!,() (3.54) 
với 1, ~ cường độ dòng điện, 
K, - hè số tỷ lệ möõmen. 


Đối với mạch điện phần ứng: 


( 


: dI, 
U,(Q=R.i,(Q+L, " "e0 (955) 


với R„ L - điện trở và điện cảm phản ứng - 
œ„ - sức phản điện động của động cơ 
Sy( v8 () (9.56) 
K, - hệ số tỷ lệ với sức phản điện động. 
Dùng phép biến đối Laplace, từ (9.55). ta có: 
U,@&)—sK,8„Ẳ@) 


I,@)= 9.57 
: R,+sL, Ngộ g 

Từ (8.53) ta có: 
M(s) = s”JÖ, (s) + sfÖ,„(s) (9.58) 


_ Và từ (9.54) ta có: | 
U,()—sKy8„(@) | ˆ 
M(s)=K  (s)=K |————————— 9 5Q 
(s)=K,Í@) | R..aL, (9.56) 
Trên cơ sở (Õ.58) và (Ổ.59) ta có: 


6„(s) | K, 
” 2 (60) 
U,(@)  s[s“ƒL, +(Lf+R I§+R,f+K,Ky] 


Đây là hàm truyền cần xác định, nó là tỷ số giữa tín hiệu ra (góc 
quay 8„) và tín hiệu vào của hệ thống (điện áp U,). 


Biến đổi (9.60) dưới đạng sau: 
ÔnG) K, 
= (9.61) 
U,@) s{sL +R,Xsl+f)+K K,I 


Bởi vì hệ thống gồm có cả động cơ và phụ tải nên tín biệu ra là 
góc quay của trục phụ tải Ô, như trong công thức .47). Cuối cùng hàm 
truyền chuyển động 1 bậc tự do của tay máy là: — - 


9.@) - nK, l 
U,@6) s[GL,+R,Xsl+f)+K,K,] ch: 


và sơ đỏ khối tương ứng như trên hình 2.21: 


Hình 9.21. Hóm truyền chuyển động môi! bậc tự do 


Để đơn giản hoá có thể không xét đến ảnh hưởng của điện cảm 
phần ứng là L, vì nó thường quá nhỗ so với các nhân tố ảnh hưởng cơ khí 
khác. Phương trình (9.62) còn lại như sau: 


0, (5) — _ nK, 
U,@s) s@&R J+Rf+KK,) (9.63) 
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9,6. ĐIỀU KHIỂN CHUYỂN ĐỘNG MỖI KHỚP ĐỘNG 

Nhiệm vụ điều khiến lúc này là làm sao cho động cơ chuyển dịch 
khớp động đi một góc bằng góc quay đã tính toán để đảm bảo theo quỹ 
đạo đã chọn (xem chương VI). Việc điều khiển được thực hiện như sau: 
theo tín hiệu sai lệch giữa giá trị thực tế và giá trị tính toán của vị trí póc 
mà điều chỉnh điện áp U,(Ð) vào động cơ. Hay nói khác đi, để điều khiển 
theo quỹ đạo phải đặt điện áp vào động cơ tỷ lệ thuận với độ sai lệch góc 
quay của khớp động. 

K,e@)  K,[{9,@)—9,()] 


U,(Q=———=———— (9.64) 
n n 


Với _ K, - hệ số truyền tín hiệu phản hồi về vị trí 
e(Ð - độ sai lệch góc quay: e(£) = ổ,() —Ø,()ˆ` 


Giá trị góc quay tức thời ổ, (? được đo báo bằng cảm biến 
(sensor) quang học hoặc chiết áp. 
Biến đổi Laplace phương trình (8.64): 


K,[ỗ, (s)—9,(s)]  K,E@) 


U @) = HN ng sang = "¬ (65) 
và thay (3.65) vào (9.63). 
0, @) _ K,Ẻ, 


` n 
EQ) —SSRJ+RJ+EKUKU) Ề (966) 


Sau khi biến đổi đại số đơn giản ta có hàm truyền: 


6,@)_GG@) _ K,K, _ 
ð,(@) I+G@) s”R,J+s(R,f+K,K,)+K,K, 
' K,K,/RJ (9.67) 
- K,K, 
sa ft K KT Si; 
R„J RJ 


Từ phương trình 68. 67) hệ điều chỉnh tỷ lệ dịch chuyển mỗi khớp 
động là hệ bậc 2. Nếu các hệ số phương trình bậc 2 này là dương thì hệ sẽ 
ồn định. Để nâng cao đặc tính động lực học của hệ và để giảm sai số tĩnh 
- có thể tăng hệ số K, và xét tới đạo hàm của độ sai lệch dịch chuyển qua 
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hẹ số K,. Muốn thế thì điện áp điều khiển động cơ sẽ tỷ lệ thuận với độ 
sai lệch địch chuyển và đạo hàm của nó. 


K,lð, @—0, (0]+ K, lÕ, (=0, (012 


+ (9.68) 
K,ed)+K,é@) 


l) 


Như vậy, khi có liên hé phản hồi hệ thông trở thành khén kín và 
sơ đồ hàm truyền biểu thị trên hình 9.22. 
Sau khi biến đối Laplace biểu thức @, 68) và thay U, vào(9. 66) ta 
có hàm truyền: 
Ô, (s) K„(K,+SÁ) K,Ks+Á Ẩ, 


ng: = =G,(s) (9. 
EQ@) ssR,J+R,ƒ+K,K,) sGRJ+R,ƒ/+K,K,) v) (69) 


Tù đó có: 
6, (v) s. Ớ, (5) = K,K,s+K,K, 


M2 205 << '970 
6,(s) T]+G @) S`Ñ,J+3(Ñ,Ƒ+K,K,+KUKU)+K,K. ` ; 


Hình 9_.22., Sơ đề điều khiển chuuến dịch 1 khớp động có liên hệ phán hồi. 
9/7. ĐĂNH GIÁ ĐẶC TÍNH ĐỘNG LỰC-CÚA HỆ ĐIỂU KHIỂN 
Trước hết cần nghiên cứu phạm vi thay đổi hệ số truyền phản hồi 
về vị trí và vận tốc (hệ số K„ và hệ số K,). Như đã biết, phương trình đặc 
trưng của hệ bậc 2 có dạng chuẩn như sau: 
s”+2ð,„s +0. =0 (9:71) 


với Š và œ, - hệ số giảm chân và tần số riêng của hệ đao động. 
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Đối chiếu giữa 2 phương trình (9.70) và (9.71) ta có: 


`... 
d0; = (9.72) 
JR, 


= R./ + K„.K, Rể TK 
_ JR 


“ 


2, 


(9.73) 


Đề đảm báo chế độ làm việc có giảm chấn cần thiết thì š > 1. Đo 
Vậy: 


NJ +, Áo tXSUẤ. _ g6 
m—.= = (9.74) 
KUK.JR, 


l 


E 
TW 
Từ điều kiện (8.74): 
2jK,K,JR,—R,ƒ-K„K 
K, > Làn “ NNG LnG, : 
K 
Để tránh đao động cộng hưởng, thường chọn: 


E 
° 


(9.75) 


r 


@œ„ <0,5 @, (9.76) 
với 0œ, - tần số cộng hưởng của hệ kết cấu. 
Tần số cộng hưởng của hệ kết cấu chủ yếu phụ thuộc vào vật liệu 
chế tạo tay máy. Nếu gọi độ cứng vững của hệ khớp độnglà K, thì 
mômen gây nên K..Ð„(t) cân bằng với mömen quán tính của động cơ: 


Jổ„()+K,„8„()=0 (977) 


Phương trình đặc trưng của biểu thức (9.77) sau khi biến đổi 
Laplace sẽ là: 


Js°+K,=0 (9.78) 
Giải phương trình trên tìm tần số cộng hưởng: 
K„ 1/2 
“@„ —= (0.79 
7 ) 


Nếu œ„ là tần số cộng hưởng đo được ứng với mômen quán tính 
J„ đã biết, thì đối với mômen quán tính J, tần số cộng hưởng tương ứng là: 


(0, = 8i) (3.80) 
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Theo điều kiện (9.76) và từ (9.72) có: 


lệ) K < Ẳœ¿JR, 'Ö`§ 
ng 981 
Ẹ 4K, ( Í ) 
Tính théra biểu thức (9.80) có: 
@gJ„Ñ _ 
0<K,<—=——* 982 
p 4K, (3 ) 
Biết K,. thay vào (9.75) nhận được: 
RuasxvJ,J -R,ƒ K„K 
 n o4 % @)83) 


K 


a 


98. ĐIỀU KHIỂN CHUYỂN ĐỘNG ROBOT NHIỀU BẬC TỰ DO. 


Nhiệm vụ qưan trọng đầu tiên của việc điều khiển robot là đấm 
bảo sao cho điểm tác động cuối E (End - effector) của cơ cấu tay máy 
phải dịch chuyển bám theo một quỹ đạo đặt trước. Không những thế, hệ 
toa đô x„„ y,, z„ gắn liền tại điểm E đó phải đuy trì theo một định hướng 
nào đó. Phương pháp giải bài toán này đã trình bày ở chương V. Đó là 
nội dung cơ bản để xây đựng chương trình điều khiển vị trí cho robot. 


Tuy nhiên khi giải bài toán này chưa xét tới các điều kiện thực tế 
khi làm việc, như là có sự tác động của mômen lực, của môi trường làm 
VIỆC V.V,.. 


Các yếu tố này sẽ lần lượt được tính tới và phương pháp điều 
khiển cũng trở nên đa dạng và phong phú hơn, tuỳ theo yêu cầu nâng cao 
chất lượng điều khiển. 


Như đã biết, các khớp động của robot đều có nguồn động lực 
riêng, nên điều khiển robot là điều khiển các nguồn động lực độc lập đó. 
Sơ đồ khối tổng quát của hệ thống điều khiển robot được. mô tả trên 


Hình 9.23. Sơ đồ hệ thống điều khiến 
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Trên hình Š.23: 
_ qụ là vectơ vị trí đặt của biến khớp; q là véctơ vị trí tức thời của 
biến khớp; v 


, 


q là véctơ tốc độ thay đổi biến khớp tương ứng; 


E„ là vectơ lực động tạo nên ở khớp động. Đó là lực hoặc mômen 
tạo nên bởi nguồn động lực ở khớp động. 
. Phương trình động lực học của robot đã được viết dưới dạng ma 
trận (Š30): 
Eụ = D(q)  +h(q, Ä)+c (4) (384 
Cấu trúc bộ điều khiển có thể lựa chọn là luật điều khiển tỷ lệ - 
đạo hàm (PD- Proportional - Derivative): 
h Eu= K;e + KsÊ (9:85) 
Trong đó: 
t E - sal số vị trí của khớp động: e = q, - q 
£ - sai số tốc độ: E = đ„ —đ 
K; - ma trận đường chéo các hệ số khuếch đại của n khớp 
động:K; = điag (Kạ,, Kẹ..... K;,). ` 
Kb - ma trận đường chéo của hệ số đạo hàm của n khớp 
động: Kp = dịag (Kau Kẹ;,.... Kp,). 


Sơ đồ hệ thống điều khiển phản hồi với cấu trúc điều khiển PD có 
dạng đơn giản như hình 9.24. 


- Hình Š)24. Sơ đồ cốu trúc hệ thống uới bộ điều khiển PD có độ tắt dẫn 
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Trên sơ đồ hình Øj24, tín hiệu đặt vị trí q; được so sánh với vị trí 
tức thời q và độ sai lệch £ tác động vào khâu khuếch đại với hệ số K;. Tín 
hiệu ra của khâu tỷ lệ được cộng đại số với tín hiệu tất dần tỷ lệ với tốc tử 
cua khớp động. 


Eụ = Kp (đa - q) + Ép q (3.86) 


Hệ thống với cấu trúc luật điều khiển PD có độ tắt dân (hình 9.24) 
sẽ không thích hợp với một số kiểu robot. Một đạng hệ thống điều khiển 
khác giới thiệu trên hình Ø'25 có bổ sung thêm tín hiệu đặt tốc độ đạ và 


độ sai lệch tốc độ É tác động vào khâu khuếch đại Ka. 


° Hình Ÿ`25. Sơ đồ cấu trúc hệ thống uới bộ điêu khiển PD 


Độ chính xác tĩnh của hệ thống điều khiển có thể nàng. cao bằng 
cách tăng hệ số khuếch đại Kạ. Tuy nhiên hệ số K; lớn sẽ làm giảm độ ổn 
định của hệ thống cũng như làm tăng độ nhiễu. Bộ điều khiển có cấu trúc 
PID (Proportional - Integral - Derivative tức là Tỷ lệ - Tích phân - Đạo 
hàm) sẽ khắc phục được nhược điểm đó của bộ điều khiển PD. Khi đó 
phương trình lực động F„ tác động lên khớp động sẽ có dạng: 


1 
Eự„= Kạe + Kạ £ +K, Jeœ)4: (08?) 


Trong đó: 
* _K,: ma trận đường chéo các hệ số tích phân của n Tp động: 
K,= điag (K,, K¿,..., K,„) 


Như vậy, tuỳ theo oấu trúc đã lựa chọn cho bộ điểu khiển, (a đem 
đối chiếu phương trình (.86) hoặc ÿ. 87) với phương trình Lagrange 
ÚŸ.84), từ đó nhận được các phương trình của hệ điêu khiển tương ứng. Từ 
các phương trình của hệ điều khiển này có thể lựa chọn K;, Kẹ và K, sáo 
cho sai ¡ lệch vị trí £ sẽ tiến tới 0. 
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CHƯƠNG X 


TRUYỀN DẪN ĐỘNG ĐIỆN CƠ 


10.1. GIỚI THIỆU CHUNG 


Thiết bị truyền dẫn động (Actuators & Power Transmission 
Devices) là phần quan trọng để hiện thực các sơ đồ động của cơ cấu tay 
máy và là phần quyết định kết cấu của robot. Như đã biết các sơ đồ động 
cơ cấu tay máy rất đa dạng và các loại hình kết cấu tay máy cũng rất 
phong phú. Tuy nhiên, qua thực tế sử dụng đã dần dần định hình các xu 
hướng về loại hình kết cấu robot. 


Trong kỹ thuật robot hiện đại có 2 xu hướng cơ bán về loại hình 
kết cấu. 


Xu hướng thứ nhất là robot chuyên dùng để đáp ứng một công 
việc rất cụ thể trong dây chuyền sản xuất và robot chuyên món hoá trang 
bị cho một nhóm thiết bị công nghiệp nào đó để thực hiện một loại hình 
công việc. Các loại robot này thường có số bậc tự do không lớn, nhưng 
lại yêu cầu cao về mức độ thao tác nhanh, về độ chính xác và độ tin cậy. 
Tuy nhiên lại khó áp dụng khi cần thay đổi các thông số công nghệ. 


Xu hướng thứ 2 là tạo ra các robot đa chức năng đề thích nghỉ 
với nhiều loại hình công nghệ hoặc với phạm ví thay đổi tương đối rộng 
các thòng số công nghệ. Các loại robot này thường có số bậc tự do cao 
hơn, cơ động hơn nhưng lại khó đảm bảo độ chính xác và độ tin cậy cao. 
Ngoài ra giá thành chế tạo lại đắt hơn và khi sử dụng, tuỳ theo công việc 
có lúc lại không đùng hết số bậc tự do. 


Mâu thuân trên có thể được khắc phục nếu áp dụng nguyên tắc 
môdun hoá khi thiết kế robot. Theo đó kết cấu robot gồm các cụm chỉ tiết 
máy điển hình có chức năng hoạt động tương đối độc lập, được gọi là các 
môđun. Các môđun này có thể được thiết kế, chế tạo chuyên môn hoá đạt 
được những tính năng kỹ thuật cao với giá thành phải chăng. Khi nối 
ghép các môđun theo nhiều phương án khác nhau có thể tạo ra các kết 
cấu hình robot khác nhau, Các robot thiết kế theo kiểu môđun hoá được 
dùng rộng rãi khi tạo dựng các môđun sản xuất linh hoạt (Flexible 
Manufa:turing Module). 


Các thiết bị truyền dẫn động là bộ phận chủ yếu để tạo ra các 
môđun kết cấu tay máy. Về nguyên tắc trong kết cấu tay máy có thể dùng 
hầu hết các thiết bị truyền dẫn động thông thường. Tuy nhiên cũng có, 


243 


những yêu cầu riêng như là gọn nhẹ, linh hoạt, dễ điều khiển, cần triệt 
. tiêu khe hở khi quay đảo chiều v.v... Vì vậy trong cơ cấu tay máy thường 
dùng một số loại thiết bị truyền dẫn động. Dưới đây trình bầy một số loại 
thiết bị truyền dẫn động thường dùng trong kết cấu tay máy: 
Chương X - truyền đẫn động điện cơ, Chương XT-truyền dẫn động thuỷ 
khí. 
10,2. TRUYỀN ĐẦN ĐỘNG CƠ KHÍ. 


Truyền dẫn động cơ khí có rất nhiều loại hình. Chúng được dùng 
rộng rãi trong kỹ thuật máy nói chung và trong kỹ thuật robot nói riêng. 
Ngoài những loại truyền dẫn động cơ khí phổ thông đã được trình bày 
trong nhiều giáo trình giảng dạy kỹ thuật, ở đây chỉ để cập đến một số 
thiết bí hay dùng trong kỹ thuật robot và còn tương đối mới mẻ. 


102.1. Bộ truyền bánh răng sóng. 
Truyền động bánh răng sóng (The harmonic drive) khác biệt so 
với các loại truyền động bánh răng khác ở chỗ nó có một bánh răng mềm 


đi sóng biến dạng và nhờ vậy mà truyền được chuyển động quay 
đhình 101). 


TS 


tận 10,1. Bộ truyền bónh răng sóng. 
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Bộ truyền bánh răng sóng gồm 3 bộ phận cơ bản: bánh răng mềm 
1, bánh răng cứng 2 và cần tạo sóng b. Bánh răng mềm có dạng ống vỏ 
mỏng. Một đầu ống nối với trục quay œ;, còn đầu kia được cắt răng với số 
răng Z„. Vành răng này được biến dạng đi một đại lượng 2W, do cần tạo 
sóng gây nên. Như mô (ả trên sơ đồ tiết diện cắt ngang (hình 10. À, do tác 
động của cần tạo sống vành răng mềm từ hình tròn biến dạng thành hình 
elip. Chu vi vành răng khi biến đạng so với chu vi.vành răng khi chưa 
biến dạng. tạo ra 2 sóng (xem hình khai triển trênhình 10.1). Phương A là 
phương biến dạng lớn, còn phương B là phương biến dạng nhỏ. Đỉnh sóng 
biến dạng nằm trên phương A, còn đấy sóng biến dạng nằm trên phương 
B. Tuy theo cách tạo sóng, số sóng biến đạng có thể là 1, 2, 3 v.v.. - thông 
thường là bộ truyền 2 sóng và quan hệ số rãng giữa bánh răng mềm với 
bánh răng cứng là Z2; - Z¡ = 2. 

Bộ truyền bánh răng sóng còn đùng để truyền chuyển động qua 
vách ngăn kín, cho nên vỏ mỏng l thường làm kín một đầu. Cần tạo sóng 
đùng để hình thành và truyền sóng biến dạng trên bánh răng mềm. Có thể 
tạo sóng bằng phương pháp cơ khí, điện từ, thuỷ lực, khí nén. Theo 


phương pháp cơ khí có thể dùng 2 con lăn, 4 con lăn, đi 1a lăn, vòng lăn 
hoặc cam lăn. 


Động học bánh răng truyền sóng: 


Ứng với mỗi vòng quay của cần tạo sóng, một răng của bánh răng 
mềm I sẽ có 2 lần vào ăn khớp với bánh răng cứng. Giả sử bánh rãng 
cứng 2 được giữ không quay, riếu cần tạo sóng quay hết Í vòng (@, = 2 T) 
thì trực quay của bánh răng mềm sẽ quay theo chiều ngược lại một góc 
bằng ọ, =2 ®(24-22)/2,. 

Từ quan hệ các gốc quay đó suy ra quan hệ các vận tốc góc: 

đ H5: (10.1) 
L4 c= 
"m — G&~-#) 2 
z \“1 2 
) 

Bây giờ giả sử giữ cho bán: răng, mềm I không quay riếu cần tạo 
sống quay trọn một góc óy = 2 7 thì bánh răng cứng 2 sẽ quay cùng 
phương như cần tạo sóng mẹ: góc quay là ợ; = 2 1(2+-Z,)/2:. 


Tù đó, ta có: 
u = Mã =— _ 28 _— = _^— ; 
27 s (10.2). 
ĐI cáo (2 se Z0) “4# | A 
2 
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Các biểu thức .(10:1);( 10.2) chứng tỏ tỷ số truyền của bộ truyền 
„bánh răng sóng chỉ pụ thuộc vào các số răng. 

Trên hình 10.2 là sơ đồ bộ truyền bánh răng sóng 2 cấp. Trong 
trường hợp này bánh răng mềm ! có 2 vành răng 2; và Z¿, ăn khớp với 
các bánh răng cứng 2 và 4 với số răng là 2; và Z„ tương ứng. Trong đó 
bánh răng cứng 2 là cố định. Chuyển động quay được truyền từ cần tạo 
sóng 3 đến bánh răng cứng 4 nhờ 2 sự ăn khớp sóng. 

Tỷ số truyền của bộ truyền bánh răng sóng nhiều cấp xác định 
tương tự như bộ truyền bánh răng hành tĩnh với công thức sau: 

2 
Rhg : (10.3) 


__ Trong bộ truyền bánh răng sóng có cấu tạo như một khớp nối trục 
(hìnhL0.2), nếu lấy 2+ = Z¡ và Z4 = 2, thì trục đầu ra của khớp nối trục 
gắn liền với bánh răng 4 và tỷ số truyền sẽ là: 

2 
=4 Hộ, 

Z; =2, kê 
Nếu lấy Z; = Z, và Z = Z¡, thì trục đầu ra gắn liền với bánh răng 4 
và có tỷ số truyền là: 


Ha = 


Mẹ =——=—-~- 
HN 27 l 


E5 * 
Hình 10.2. Bộ truyền bónh răng sóng 2 cấp. 
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Đặc điểm ăn khớp của bánh răng sóng. 

~- Nhờ có bánh răng mềm biến dạng được nêri khe hở giỮa các cặp 
răng Z, và Z„ ở miền đỉnh sóng là rất bé, hoặc gần như triệt tiêu. 

- Cũng nhờ sự biến dạng của bánh răng mềm nền trong bộ truyền 
bánh răng sóng có số lớn cặp răng cùng ăn khớp (đến 40%). 


Hũnh 10.8. Bộ truyền bánh răng sóng xuyên qua uách ngăn 


- Bộ truyền bánh răng sóng đạt được tỷ số truyền lớn. Đối với bộ 
truyền dùng bánh răng mềm bằng thép, nếu một cấp thì n = 50 + 300, nếu 
2 cấp thì u = 200 + 10” hoặc còn có thể cao hơn nữa. 

- Do có nhiều cặp răng cùng ăn khớp và có thể tạo ra một vài vùng 
ăn khớp đồng thời, cho nên có thể bù trừ được các sai số chế tạo, sai số 
lắp rắp và nói chung đạt được độ chính xác động lực tương đối cao. Cũng 
nhờ vậy mà bộ truyền bánh răng sóng làm việc đều hoà và ít gây tiếng ồn 
hơn so với các loại bánh răng khác. 


- Hiện suất bộ truyền bánh răng sóng cũng khong thấp, ví dụ, khi 
tỷ số truyền u = 50 + 200 thì hiệu suất trong khoảng 70 + 85%, 


- Ngoài ra bộ truyền bánh rãng sóng còn có ưu điểm nữa là nhờ có 
vành răng mềm ở một đầu ống vỏ mỏng, biến dạng lại không lớn, ống vỏ 
mỏng có thể làm một đầu kín nên có thể tạo ra cơ cấu bộ truyền xuyên 
qua vách ngăn kín giữa 2 môi trường khác nhau (xem hình!03). Đối với 
bánh răng mềm bằng thép thì độ biến đạng W, = (0,003 + 0,015)đ,. còn 
chiều dày vỏ mỏng chỗ chân răng bến =6, 005 + 0,03)d,, với d, l về: `. 
kính ống vỏ mỏng. 
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Sử đụng truyền động bánh răng sóng. 


. Do có các tính chất nói trên, truyền động bánh răng sóng; được 
đùng chủ yếu ở các bộ truyền cần tỷ số truyền cao, các bộ truyền đòi hỏi 
độ chính xác cao, các cơ cấu có quán tính nhỏ và yêu cầu tác động, nhanh 
trong hệ thống điều khiển tự động, các khớp động trong tay máy. Ngoài 
ra còn dùng để truyền chuyển động xuyên qua vách ngăn và kín khít đối 
với môi trường hoá chất hoặc phóng xạ v...V, : 


Đưới đây giới thiệu một vài ứng dụng truyền động bánh nng Sống 
trong kết cấu robot. 


Trên hình1ổ4 là sơ đồ cấu tạo một khớp quay dùng bánh răng - 
sóng. Trong thân hộp I đặt động cơ điện 3 và bộ phận 2 nhân tín hiệu 
phản hồi liên hệ với trục động cơ bằng các bánh răng 4, 5, 6. Bánh lng 5 
gắn liền với trục 10 đấu vào bộ truyền bánh răng sóng. Trục 10 lâ trục 
khuýu, trên đó gắn các đĩa 9 để tạo sóng biến đạng cho bánh răng mềm 8. 
Bánh răng 8 này ăn khớp với bánh răng cứng 7 cố định và gắn với trục 
đầu ra 1] của bộ truyền bánh răng sóng. Trục iI gấn liền với khâu tiếp 
the+2 của cơ cấu tay máy. 


Sơ đồ áp dụng trên hình10.4a chỉ thích hợp với trường hợp công 
suất động cơ không lớn. Khối lửợng của động cơ không vượt quá khối 
lượng của bộ truyền bánh răng sóng. Thường thường phải lấp một phanh 
hãm ôm lấy trục động cơ khi ngắt điện, bởi vì bộ truyền bánh răng sóng 
một cấp có thể quay ngược, tức là không tự hãm được. Khi lắp phanh hãm 
thường làm giảm độ tin cậy của bộ truyền và gây nên tải trọng động 
không mong muốn lúc phanh hãm. Bởi thế có thể áp dụng phương án 
khác dùng các cơ cấu có thể tự hãm được, ví đụ, bánh vít trục vít như 
hình ỡ4. 


ng) 
4 
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Hình 10.4. Sứ dụng bộ truyền bánh răng sóng 


trong khớp quau tay mau 
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Sơ đồ trên hình!04b gồm có động cơ điện 2 lắp trong thân hộp l 
có trục nối liển với trục vít 3, ăn khớp với bánh vít 4. Trục bánh vít 4 nối 
với trục đầu vào 5 của bộ truyền bánh răng sóng. Các đĩa 7 lắp lệch tâm 
trên trục 5 sẽ gây biến đạng sóng cho bánh răng mềm 8, ăn khớp với bánh 
răng cứng 9. Bánh răng mềm 8 có dạng hình ống vỏ mỏng, được cố định 
nhờ bộ phận 6. Còn bánh răng cứng 9 lại quay trong ổ bí 10. Chính ổ bị 
10 cũng là khớp quay của khâu Ï ! tiếp theo. 


Nhược điểm của cả hai sơ đồ hình! Ò.4a vài0.4b là do để đảm bảo 
độ dài của các bánh răng mềm cho nên làm tăng các khối lượng và kích 
thước chiều trục của các khớp quay. Ngoài ra với các kết cấu nói trên sẽ 
khó khăn luồn dây øáp điện từ khâu này sang khâu kia của tay máy. 


“Trên hình10.5 là sơ đồ khớp quay thân của robot ASEA IRb - 6, 
dùng bộ truyền bánh răng sóng có trục rỗng, thuận tiến cho việc luồn các 
dây cấp điện. Trong thân hộp cố định L lắp động cơ điện 2. Tiếp theo là 
cặp bánh răng 3 có góc răng nghiêng lớn để tự hăm được. Trục bánh răng 
3 nối liền với trục khuỷu chủ động 4, trên đó lắp các đĩa 5 cùng các vòng 
bị 6 gây biến dạng cho vành răng mềm 7. Vành răng mềm 7 là vành răng 
trong ống mỏng được cố định với thân hộp nhờ bộ phận 14. Vành răng 
mềm 7 ăn khớp với vành răng cứng 10 trên ống trụ rỗng 9. Ông trụ 9 
quay trong các ố bi 8. Ngoài trục khuỷu chủ động 4 có lắp thêm trục 
khuỷu bị động 11 và nhờ các đĩa lăn tương tự mà trục !] quay rồi qua 
khớp trục 12 truyền tín hiệu quay đến bộ phậm cảm biến phản hồi 13. 


Đối với các robot làm việc trong môi trường đặc biệt, ví dụ, trong 
môi trường ăn mòn, cần phải cách ly các bộ truyền động và động cơ điện 
với môi trường đó. Trong trường hợp này có thể sử dụng bộ truyền bánh 
răng sóng có bánh răng mẻm được làm kín, như trên hình? 10.6. 


Hình 10.5. Sơ đồ khớp qua thân robot ÍFb - 6 dùng bánh rông sórg: 
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Trong thân hộp 1 (hình)06) láp đặt động cơ điện 2. Trục của nó 
nối liền với trục vít 3, bánh răng vít 4 và truyền chuyển động sang trục Š 
là trục đầu vào của bộ truyền bánh răng sóng. Bánh răng mềm 8 có dạng 
một ống vỏ mỏng bịt kín một đầu và nối với thân hộp I bằng các bộ phận 
làm kín 11. Các đĩa 9 tạo sóng biến đạng cho vành răng mềm 8, ăn khớp 
với bánh răng cứng 7. Bánh răng này. quay tròn trên các ổ bi 6 và phần 
cuối của nó gắn liền khâu I0 tiếp theo. Như vậy, các bộ phận bên trong 


Hình 10.6. Sơ đồ 
khớp quay robot 
dùng bánh răng 

sóng làm uiệc ở môi 

trường đặc biệt 


thân hộp hoàn toàn được cách ly với môi trường bên ngoài. Nếu trên mặt 

đĩa bánh vít có khoan các lễ và đặt nguồn sáng 12 ở một phía, còn phía 
kia đặt tế bào quang điện 13 thì đó là một cơ cấu cảm biến đơn giản nhận 
tín hiệu phản hồi vì góc quay hoặc tốc độ quay qua hệ thống đếm xung. 


102.2. Bộ truyền động bánh răng con lăn - cycloid hành tỉnh. 


Trong những năm gản đây truyền động bánh răng cycloid hành 
tỉnh lại được quan tâm nghiên cứu cải tiến và ứng dụng tương đối rộng rãi 
ở các bộ truyền dẫn trong robot. Truyền động này có nhiều ưu điểm như: 
đạt được tỷ số truyền cao, gọn nhẹ, độ bền và độ chính xác đầu cao hơn 
so với nhiều loại truyền động khác. Tuy nhiên lại yêu cầu cao : độ chính 
xác chế tạo và lắp ráp. 


Trên hình107a là sơ đồ một hộp giảm tốc bánh răng cycloid hành 
tình, gồm bánh răng trung tâm cố định a, cần quay H, bánh răng vệ tỉnh b 
và bánh răng c. 


Trên hình107b giới thiệu thêm một sơ đồ hộp giảm tốc bánh răng 
cyclotd hành tính. Bánh răng b có số răng Z„, bánh răng a có số rãng 
Z¿ = Z, + 1. Khi quay cần H bánh răng vệ tình b có chuyển động song 
phẳng và nhờ cơ cấu tay quay đ làm cho bánh ráng c quay theo. Tỷ số : 
truyền từ cần quay đến trục của bánh c là u„„ = - 2. 


Đối với hộp giảm tốc I cấp tỷ số truyền đạt tới 87 còn đối với hộp 
giảm tốc 2 cấp hoặc 3 cấp có thể đạt được tỷ số truyền rất cao. 
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Hình 10.7. Sơ đồ hộp giảm tốc bánh răng cycloid hành tình 
) 


Trong cập bánh răng cycloid hành tình, một bánh có răng hình 
con lăn, còn bánh răng ăn khớp với nó có dạng răng họ đường epicyloid. 


Trên hìnhÌ0.8, r, và r; là „ 
bán kính vồng lăn (vòng tâm tích). 
Khi lăn vòng r; trên vòng r,, một 
điểm B nào đó nằm trên vòng tròn 
r; sẽ vẽ nên đường epicyloid BẠB,. 
Nếu thay điểm Bạ bằng điểm D, 
cũnp gắn liền với vòng trong r; 
nhưng nằm phía ngoài vòng r; thì 
khi lăn vòng r; trên vòng r,, điểm 
Dạ sẽ vẽ nên đường D,D, epicyloid 
kéo đài (infected epicyloid). Bây 
giờ nếu thay điểm D, bằng chốt 
đường kính 2r thì khi lần vòng r; 
trên vòng r, bao hình của các con 
_ lăn là đường số 3 cách đều đường _ b 
epicyloid kéo đài. Đó chính là Hãnh 10.8. Sơ đổ tạo hình ăn khớp 
dạng răng ăn khớp với bánh răng bánh răng cụcloid 
con lăn! Như vậy đối với bộ truyền bánh răng con lăn, cặp bánh răng ăn 
khớp với nhau có biên dạng là đường số 3 và vòng tròn bán kính r của con 
lăn. 


“ườợH 
c1 CD, h 
D› C) 


: “óo 
: 
‡ 


: Quá trình hình thành đường B,B, và đường D,D, đều hoàn thành 
khi bánh 2 quay đi cùng mật góc bằng 2n. Khi đó vòng lăn 2 đã lăn đi 
vừa tròn một vòng 27r;, còn vòng lăn ! đã lăn đi một độ dài là : 


2rr,= BạB, =2nr,+l q06), 
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với t là bước ràng. 


Do đó: 
t= 2# (r; - ) = 21A. q10.) 
Với A =0,0;. Mặt khác ta có: 
f= 2n £ 
Z\ (10.8) 


__ Với Z, là số (nguyên) lần đường B,B, vẽ HUẾ trên chu vị vòng lăn 
1. So sánh, (9017), (0.8) ta có: 


=A2, (10.9) 
và t,=r,+A= A(2 + D) (19.10) 
Vì rằng: . 
h2 : 
`... | (10.11) 
và trên cơ sở ú0. 3ÿ 0, 0) tạcồ, 
2= Z.+ nì (10:1) 


Nói cách khác, số con lăn 2; phân bố trên bánh 2 phải lớn hơn số 
răng 2, (số đường B,B,) của bảnh 1 là 1 đơn vị. 


_ữŒ0.11) và (10,12) ,tacó: 
h 2 Á 
n.. 10.13) 
w„,„ Z+l Vu ) 


Trên hình1Õ.9 là bộ truyền bánh răng có biên đạng răng ăn khớp . 
với con lăn là đường cách đều epicycloid keó dài gọi tất là bộ truyền bánh 
răng con lăn - epicycloid. 


Tương tự với bộ truyền răng con lần - epicycloid, có thể tạo ra bộ 
truyền bánh răng cơn lăn - hypocycloid. Khi vòng lăn r, lăn trên vòng lăn 
r, thì điểm B, nằm trên vòng lăn r, sẽ vẽ nên đường hypocycloid BỊJB, và 
điểm D, gắn liền với vòng lăn r, nhưng nằm phía ngoài vòng lăn r, sẽ vẽ 
nên đường hwpocycloid kéo đài D„D,. Cặp bánh răng ăn khớp có biến 
đạng răng tương ứng là vòng tròn con lăn bán kính r ăn khớp với đường 
cách đều (khoảng r) so với đường hypocycloid kéo dài. 
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"Ninh 10.9. Bộ truyền bánh răng con lăn - epicueloid. 


Theo cách suy hiận như đã làm ở trên, ta có 


Z,=Z +, | (10.14) 
và 

TÍY cê 2: 

Bào ZiT (10.15) 


Trên hình1010 là bộ truyền 
bánh răng có biên dạng răng 
ãn khớp với con lãn là đường 
cách đều hypocycloid kéo 
dài, gọi tắt là bộ truyền bánh 
răng con lăn - hypocycloid. 


Sự khác biệt của bộ truyền 
bánh rãng con lăn ›: 
hypocycloid so với bộ truyền 
bánh răng con lăn - 
.epIcycloid là các con lăn 
được bố trí trên bánh ] chứ 
khiông phải trên bánh 2. 

Cả 2 loại truyền động bánh 
răng cycloid này có đặc điểm 
là chỗ các răng tiếp xúc với 


"... ` ‹ nhau đều năm ngoài vùng 
Hình 10.10. Bộ truyền bánh răng —.. tâm 'quảy tứcchời (là tiếp 


con lần- hụpocvcloid. 
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điểm của 2 vòng lăn hoạc 2 vòng tâm tích} nên còn có tên gọi là 'UYÊ 
động bánh răng "ngoài tâm tích”. 


Theo lí thuyết ăn khớp thì nếu điểm tiếp xúc nằm càng xa trung 
tâm tức thời thì vận tốc trượt giữa hai mặt răng ăn khớp càng lớn, do vậy 
hiệu suất càng thấp và càng chóng mồn. Tuy thuộc loại ăn khớp "ngoài 
tâm tích” nhưng ở truyền động bánh răng con lăn vận tốc trượt lại rất 
thấp. bởi vì vận tốc góc tương đối œ;„ rất thấp. 


(10.16) 


l 
Khi Z;-Z, = I thì œ¡;=œ, l/Z¿ 


Một đặc điểm nữa đáng lưu ý của các truyền động ăn khớp 
cycloid nói trên là về nguyên lý thì tất cả các con lăn đều đồng thời tiếp 
xúc Với mặt răng tương ứng, cho nên khả năng truyền lực là rất lớn. Điều 
này xuất phát từ lý do là tâm của tất cả các con lăn đều nằm cách đều 
đường D,D, và biên dạng của rãng ăn khớp với con lăn lại là đường bao 
hình của các vị trí con lăn, cách đêu đường D,ạD,. Điểm tiếp xúc giữa biên 
đạng răng và con lăn sẽ là điểm mà pháp tuyến của biên dạng răng đi qua 
tâm con lặn. 


Tuy rằng tất cả các con lăn đều đồng thời tiếp xúc với mặt răng 
tương ứng, nhưng vì truyền lực chỉ theo một chiều cho nên tối đa là chỉ có 
nửa số con lăn tham gia vào ăn khớp. Vậy hệ số tràng khớp của bánh răng 
con lăn cycloid là: 


Si Na | I0 
2 : .17) 
với Z, - số răng con lăn. Thực tế số răng con lăn trực tiếp tham gia ăn 


khớp có thể ít hơn 2 do sai số chế tạo và lấp ráp. 


'Đặc điểm các con lăn đều đồng thời tiếp xúc nói trên đã lý giải về 
một ưu điểm nữa của bộ truyền bánh răng con lăn cycloid là làm việc êm 
khi đảo chiều. 


1Ỗ.2.3. Truyền động vít đai ốc bi. 


Truyền động vít đai ốc bi (ball screws) được dùng đầu tiên trong 
cơ cấu tay lái của ô tô ở hãng General Motors. Những năm đầu của những 
năm 50,: Beaver Precision là hãng đầu tiên thiết kế và chế tạo bộ truyền đai 
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ốc bi cho các máy điểu khiển số. 
Ngày nay đã rất nhiều hãng sản xuất 
bộ truyền vít đai ốc bị, nhiều cải tiến 
mới và ứng dụng rất rộng rãi trong 
nhiều lĩnh vực, trong đó có kỹ thuật 
robot. Công dụng chủ yến của bộ 
truyền vít đai ốc bi là để biến chuyển 
động quay sang chuyển động tịnh 
tiến. Nhiệm vụ này có thế được thực 
hiện bằng bộ truyền thanh răng - bánh 
răng hoặc bộ truyền vít đai ốc thường. 
Tuy nhiên, như trên hình10.11 mô tả 
bộ truyền vít đai ốc thường, ví đụ, vít 
đai ốc ren hình thang (hìnhJ011a) thì 
tiếp Xúc giữa đai ốc và ren vít là tiếp 
xúc giữa 2 bề mặt, nên tổn thất ma sát 
rất lớn, Còn nếu cho chen bỉ giữa 2 


(À0) 


<< 


Hình 10. 11. Sơ đồ tiếp xúc 
trợng bộ truyền uít đại ốc bị 


mặt ren lõm của đai ốc và vít (hìnhØ.11b) thì hiệu suất của bộ truyền có 
thể lên tới 90%. Tuy nhiên diện tích tiếp xúc lại bé đi, nên khả năng chịu 
tải thấp hơn. Vì vậy phải chọn lựa hợp lí quan hệ đường kính viên bị và 
đường kính tiết diện cắt ngang của các rãnh lăn, phù hợp các điểu kiện 
ứng dụng cụ thể, như tốc độ đi chuyển, hiệu ứng màng dầu thuỷ động, 


kích cỡ bộ truyền v...V. 


Đa 


Hình 10.12. Sơ đồ kết cấu bộ truyền uít đai ốc bi 


⁄ 
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Kết cấu bộ truyền vít đai ốc bị ngày nay đã có nhiều loại hình 
khác nhau, ví đụ, vít đai ốc bi có thể luân chuyển bi trong rãnh, hoặc vít 
đai ốc lăn có chuyển động con lăn hành tính (planetary roller screw) v.v... 
Trên hìnhi Ơ.12 giới thiệu sơ đồ kết cấu bộ truyền vít đai ốc bị loại thường 
dùng. 


Như trên đã nhắc, việc chọn lựa hình dáng và kích thước rãnh bị 
lăn có liên quan nhiều đến công nghệ chế tạo và khả năng đạt được độ 
chính xác gia công. Trong. [51] đề cấp đến vấn đề tạo hình các mặt ren 
lõm. 


Các ưu điểm chủ yếu của truyền động vít đai ốc bi là hiệu suất 
cao, độ chính xác định vị cao, độ bền cao và mômen khởi động thấp. Tuy 
nhiên, giá thành tương đối cao và đòi hỏi bảo dưỡng, tu sửa thường 
Xuyên. 


16. 3. ỨNG DỰNG TRUYVỀN ĐỘNG ĐIỆN 


Truyền đông điện được dùng khá nhiều trong kỹ thuật robot, vì có 
những ưu điểm như là điều khiển đơn giản không phải dùng các bộ biến 
đổi phụ thêm, không gây bần cho môi trường, các loại động cơ hiện đại 
có thể lấp trực tiếp trên các khớp quay v...V. 


Tuy nhiên so với truyền động thuỷ khí thì truyền động điện có tỷ 
lệ thấp giữa công suất truyền trên một đơn vị khối lượng và thông thường 
đồi hỏi kèm theo hộp giảm tốc cồng kềnh vì trong tay máy tốc độ quay 
rất chậm v.v.... 

Trong kỹ thuật robot về nguyên tắc có thể đùng động cơ điện các - 
loại khác nhau, nhưng trong thực tế chỉ có 2 loại được dùng nhiều hơn cả. 
Đó là động cơ điện một chiều và động cơ bước. 

Ngày nay do những thành công mới trong nghiên cứu điều khiển 
động cơ xoay chiều, nên cũng có xu hướng chuyển sang sử dụng động cơ 
xoay chiều để tránh phải trang bị thêm bộ nguồn điện I chiều. Ngoài ra. 


loại động cơ một chiêu không chổi góp (DC brushless motor) cũng bắt 
đầu được ứng dụng nhiều. 


J0 3. L, Động cơ điện một chiều. 
Đại cương về động cơ điện một chiều 
Động cơ điện một chiều gồm có 2 phần (hìn‡Q f3): 


a) Stato cố định với các cuộn dây có dòng điện cám hoặc dùng 
nam châm vĩnh cửu. Phần này còn gọi là phẩn cảm. Phần cảm tạo nên từ 
thông trong khe hở không.khí. 


25% 


b) Roto với các thanh dẫn. Khi có dòng điện một chiều chạy qua 
và với dòng từ thông xác định, roto sẽ quay. Phần này còn gọi là phẩn 
ứng. Ạ 


Trên hìnhiổ 13: 1-thanh dẫn, 2-chổi góp, 3-cuộn dây, 4 - vòng góp 


Hình 10.13. Sơ đồ động cơ điện mội chiều. 


Do cách khác nhau khi bố trí đây cuốn phần cảm so với phần ứng 
ta có những loại động cơ điện một chiều khác nhau: 


- Động cơ kích từ song song. 

- Động cơ kích từ nối tiếp. 

- Động cơ kích từ hỗn hợp. 

Các đại lượng chủ yếu xác định sự làm việc của động cơ một 
chiều là: 

U - điện áp cung cấp của phần ứng. 

Í - cường độ đòng điện trong phần ứng. 


r - điện trở trong của phần ứng. 
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@ - từ thông trong khe hỡ. 
E - sức phản điện động phần ứng. 
Các quan hệ cơ bản khi làm việc là: 
E=U-rl=knè$ (10.18) 
k phụ thuộc vào đặc tính của dây cuốn và số thanh dẫn tác dụng của phần 
ứng. 
Từ (10.18) có các nhận xét sau: 
L)Khởi động E bàng 0 khi mở máy, chỉ có điện trở phần ứng r rất 
nhỏ hạn chế dòng điện. Vì thế cân phải có biến trở rnở máy để duy trì Ï ở 
giá trị thích hợp. 
2) Số vòng quay: 
U-tr 
kó (I( 19) 


Vậy, điều chỉnh tốc độ có thể tiến hành bằng cách tác động vào 
điện ấp U hoặc tác động vào từ thông $. 


3) Mômen động C xác định từ phương trình cân bằng công suất. 
bl = 2znC (1020) 
Kết hợpvới (9.18), ta có: 
C =2 Bà cã (19.21) 
7T 
Điều chỉnh tốc độ động cơ điện một chiêu. 


Về phương điện điều chỉnh tốc độ thì động cơ điện một chiều có. 
nhiều ưu việt hơn hẳn các động cơ khác. Khả năng điều chỉnh tốc độ dễ 
dàng trong đải rộng và có cấu trúc mạch lực và mạch điều khiển đơn gián. 


Như đã nói ở trên, có 2 phương pháp cơ bản để điều - chỉnh tốc độ 
động cơ điện một chiều: 


- Tác động lên từ thông ‡ thông qua việc điều chỉnh điện áp đồng 
kích từ. 


- Điều chỉnh điện áp phần ứng. 
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Khi điều chỉnh tốc độ từ 0 đến tốc độ định mức bằng cách giữ từ 
thông không đổi và tác động vào điện áp phần ứng U thì mômen sẽ không - 
đổi, còn công suất tàng theo tốc độ. 

Khi điều chỉnh tốc độ từ 0 đến tốc độ định mức bằng cách tác 
động lên từ thông và giữ điện áp phần ứng không đổi thì công suất không 
đổi. còn mômen giảm theo tốc đó. 

Khi từ thông tiến về 0 thì tốc độ tiến đến võ cùng£CI0.[9) Vì vậy 
khi không tải động cơ kích từ nối tiếp có tốc độ quá lớn, các loại động cơ 
kích từ song song hoặc hỗn hợp đều quá tốc độ nếu vắt mạch kích từ của 
nó. 


Đảo chiều quay. 

Chiều quay của phần ứng phụ thuộc vào chiều dòng điện trong 
dây quấn phần ứng và chiều của từ trường. Để đổi chiều quay của động 
cơ điện một chiều cần đổi hoặc chiều của từ thông (tức là chiều của đồng 
điện kích từ) hoặc chiều đồng điện phần ứng. 

.. 1ữ.3.2 Động cơ bước. 

Nguyên tắc hoạt động. 

Trên hình10.14là sơ đồ động cơ bước (stepping motor) loại đơn 
giản nhất đùng nam châm vĩnh cửu gồm stato có 4 cực và roto có 2 cực. 
Nếu cấp điện cho cuộn dây ơ œ' thì roto sẽ dừng ở vị trí mà dòng từ qua 
cuộn dây là lớn nhất. Nếu cấp điện cho cuộn dây § Ð' thì ro(o sẽ quay đi 
+90” (phụ thuộc vào chiều dòng điện cấp vào). Khí đồng thời cấp điện 
cho cá 2 cuộn dây œ và 0 thì roto sế dừng ớ vị trí giữa 0° đến 90° và nếu 
dòng điện vào 2 cuộn đây hoàn toàn như nhau thì roto sẽ đừng ở vị trí 45°. 


Hình 10.14. Sơ đồ nguyên lú hoạt động của động cơ bước 
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Như vậy, vị trí của roto phụ thuộc vào số cực được cấp trên stato 
và vào chiều của dòng điện cấp vào. 


Trên đây là sơ đồ nguyên lý hoạt động của động cơ bước loại có ít 
cực và dùng nam châm vĩnh cửu. Trên cơ sở đó có thể tìm hiểu các loại 
động cơ có nhiều cực và dùng nam châm điện có từ tính thay đổi 


Vậy là tuỳ theo cách cấp điện cho các cuộn dây trên stato có thể 
điều khiển các vị trí dừng cuả rotor. Việc cấp điện vào các cuộn dây có 
thể số hoá, cho nên có thể hiểu động cơ bước là một loại động cơ điện, 
chuyển các tín hiệu số đầu vào thành các chuyển động cơ học từng nấc ở 
đầu ra. 

Ưu nhược điểm. 

Việc sử dụng chúng trong hệ thống điều khiển có nhiều thuận lợi: 

- Không cần mạch phản hồi cho cả điều khiển vị trí và vận tốc. 

- Thích hợp với các thiết bị điều khiển số. 

Ưu diểm lớn nhất của động cơ bước trong điều khiển vị trí là 
khòng cần phản hồi (khi điều khiển chính xác số bước quay của động cơ, 
đếm số bước có thể xác định vị trí chính xác mà không cần đến phản hồi 
vị trí và điều khiến số trực tiếp (ghép nối trực tiếp với máy tính). Với khả 
năng điều khiển số trực tiếp. động cơ bước trở thành rất thông dụng trong 
các thiết bị hiện đại như robot công nghiệp, máy công cụ điều khiến số, 
các thiết bị ngoại vị của máy tính như trong máy in kim, bộ điều khiến ổ 
đĩa máy vị tính, máy vẽ. v.v... 

Tuy vậy, phạm vì ứng dụng của động cơ bước vẫn là ở vùng công 
suất nhỏ và trung bình. Việc nghiên cứu nâng công suất của động cơ bước 
đang là vấn đề rất được quan tâm hiện nay. Ngoài ra nói chung hiệu suất 
của nó thấp hơn so với nhiều loại động cơ khác. 

Các thông số của động cơ bước. 

Gác quay: 


Động cơ bước quay I góc xác định ứng với mỗi xung kích. Góc 
bước 9 càng nhỏ thì độ phân giải vị trí càng cao. Số bước s là một thông 
SỐ quan frọng. : 


360° lề, 
5= 8 : (10.22) 


Tốc độ quay và tân số xung 


Tốc độ quay của động cơ bước phụ thuộc vào số bước rong 1 
giây. Đối với hầu hết các động cơ bước, số xung cấp cho động cơ bằng số 
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bước nên tốc độ có thể tính theo tần số xung f. Tốc độ quay của động cơ 
bước tính theo công thức sau: 


60f 
LJ E2 EDS (10.23) 
S 
trong đó: n - tốc độ quay (vòng/g1ây) 
f - tần số bước (H;) 
s - số bước 


Ngoài ra còn các thöng số quan trọng khác như độ chính xác vị trí 
và tỷ số mômen và quán tính roto. Độ chính xác vị trí của động cơ bước 
phụ thuộc vào đặc tính của động cơ, vào độ chính xác chế tạo v...v. Tỷ số 
mômen và quan tính roio có ảnh hưởng quyết định đến khả năng dừng 
ngay khi chuỗi xung điều khiển đã ngắt. 


Các loại động cơ bước. 


Tuỳ theo kiểu của roto, động cơ bước được chia thành các loại 
Sau: 


- Động cơ bước loại từ trở biến đổi (VR). 

- Động cơ bước nam châm vĩnh cửu (PM). 

- Động cơ bước kiểu lai (hybrid). 

Tuỳ theo số cuộn dây độc lập trên stato động cơ bước được chia 
thành các loại: 2 pha, 3 pha hoặc 4 pha. 

Động cơ bước có thể được phân theo cách nối dây, không liên 
quan đến số pha. Trên hình| 0 I5 giới thiệu các cách nối dây: 


a/ 2 pha: 4 đầu dây b/ 2 pha: 6 đầu dây 
c/ 2 pha: 8 đầu dây d/ 3 pha: 4 đầu dây 
©/ 4 pha: 8 đầu dây f/ 4 pha: § đầu dây (nối tiếp) 


Roto có nhiều cực, còn gọi là răng. Số cực của roto phối hợp với 
số cực của stato xác định giá trị góc bước 9. Như biểu thức( I0.22)có góc 
bước Ô bằng 360” chia cho số bước s. Góc bước lớn nhất là 90° ứng với 
động cơ có 4 bước. Phần lớn những động cơ bước hiện nay có số bước 
s= 200, nên 6 = 1,8Ẻ. 

Số bước càng lớn, độ phân giải càng cao và định vị càng chính 
xác. Trong thực tế cũng không thể tăng số bước lén quá cao. Tuy nhiên, 
có thể dùng công nghệ tạo bước nhỏ để chia bước thành 2 nửa bước hoặc 
từ 10 đến 125 bước nhỏ. Đế hiểu bản chất của công nghệ này, trở lại hình 
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10.14, nhận thấy rằng có thể làm cho toto đừng lại ở nứa đường nếu cung 
cấp dòng điện như nhau cho cả 2 cuộn đây œ và B. Công nghệ tạo bước 
nhỏ. đôi khi còn gọi là tạo ví bước, chỉ đơn giản là mở rộng phương pháp 
nói trên cho nhiều vị trí trung gian bằng cách cung cấp những giá trị dòng 
khác nhau cho mỗi cuộn dây. Kích thước bước nhỏ thường hay dùng nhất 
là 1/10. 1/16/ 1/32 và 1/125 của bước đầy. Du điểm hiển nhiên của bước 
nhỏ là có độ phân giải tính hơn nhiều. Ví dụ, nếu có 125 bước nhỏ trong 
một bước với 200 bước trong một vòng quay thì độ phận giải là 200x L25 
= 25000 bước nhỏ trong một vòng quay. 


HH tú li 
JHh 


LD) Có 
2 


) : „ 
Hình. 10.15. Pha của động cơ uà các cách nối dâu. 
Động cơ bước loại từ trở biến đổi (VR). 


Rorto của động cơ bước VR làm bằng sắt non có nhiều ráng. Stato 


Hình 10.16. Sơ đồ động cơ hức VR 
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cũng có các ráng cùng cuộn cảm (hình?0.7@). Khi dòng điện chạy qua 
một cuộn cảm trên stato sinh ra một từ trường làm cho răng trên rotro bị 
hút đứng thẳng hàng với răng tương ứng trên stato. Khi dòng điện được 
cấp sang một cuộn cảm khác, roto chuyển dịch một góc bước. Góc bước 
của động cơ VR thường là 7,5” hoặc 15”. Đặc điểm của động cơ bước VR. 
là do roto sắt non có quán tính nhỏ hơn các loại khác, nèn cho phép đáp 
ứng nhanh hơn. Tuy nhiên do roto không có từ trường nên không có 
raômen dư đo đó khi ngừng kích thích động cơ sẽ còn quay tự do. 


Động cơ bước nam châm vĩnh cứu (PM) 


Động cơ bước PM có từ trường trong roto nên có mômen giữ khi 
động cơ không được kích hoạt. Mỗi răng của từ trường đều hướng trục 
cực tính là nam hoặc bắc. Trong kỹ thuật hiện đại roto được làm ở dạng 
đĩa mỏng băng vật liệu từ tính đặc biệt. Đĩa được nhiễm từ tới 50 cập cực 
nam - bắc xen kẽ nhau. Một số động cơ bước có từ trường được đưa vào 
stato để tăng từ trường và tạo ra mômen lớn hơn. Động cơ bước PM đòi 
hỏi ít nâng lượng kích hoạt hơn các loại động cơ bước khác. Chúng còn 
có đặc tính tất đao động tốt hơn. Góc bước của chúng bao gồm tất cả các 
góc bước chuẩn 1,8"; 7,5”; 15°, 30°; 45° và 90”. Trên hìnhJ0.17 là sơ đồ 
động cơ bước PM 4 pha. 


2z2o 


Hình 10.17. Sơ đồ động cơ bước PM 4 pha. 


Động cơ bước kiểu lai (hybri4) 

Động cơ bước kiểu lai kết hợp các đặc tính của động cơ bước VR 
và động cơ bước PM. Động cơ bước kiểu lai có nhiều răng roto hơn và 
mômen lớn hơn (hình10.18). Các góc bước thông dụng của động cơ bước 
kiểu l:u ¡a 0,9” và 1,85." 
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Hình 10.18. Sơ đồ động cơ bước kiểu lai 


264 


CHƯƠNG XI 


TRUYỀN DẪN ĐỘNG THUỶ KHÍ 


11,1, CÁC KHÁI NIỆM CƠ BẢN 


Trong kỹ thuật người máy công nghiệp rất hay dùng các hệ thống 
truvén dân thuỷ lực hoặc khí nén. Trong các hệ thống này năng lượng, 
được truyền đi bằng chất lòng hoặc chất khí dưới tác đụng của áp lực tạo 
ra từ các nguồn máy bơm, máy nén. 


Áp suất p của chất lỏng hoặc chất khí có thể hiểu như nội thế 
năng e, trong một đơn vị thế tích. Thường dùng đơn vị đo là pascal (p,) 
hoặc bar (Ibar = 10” p,). 


Ngoài ra còn phần thế năng e, phụ thuộc độ cao của chất lòng 
hoặc chất khí đưới tác dụng của sức hút trọng trường. Tuy nhiên trong tay 
máy sự thay đối độ cao này không lớn nên có thể bỏ qua e,. 


Mặt khác chất lông hoặc chất khí chuyển động trong hệ thống với 
vận tốc u tạo ra một động năng tính trẻn một đơn vị thể tích là e, = 1/2pu” 
(p là mật độ). 


Như vậy có thể xem xét hai nhóm phương pháp biến đổi năng 
lượng của chất lỏng hoặc của chất khí thành cơ năng: phương pháp tĩnh 
và phương pháp động. 


Đối với các phương pháp động, đều được cho ràng, thế năng của 
chất lỏng hoặc chất khí thoạt đầu sẽ biến thành động năng tạo nên sự 
chuyến dịch với vận tốc nhanh dần. Do vậy tạo nên những hiệu ứng động 
lực, chẳng hạn như trong tuabin v.v... 

Trong kỹ thuật người máy công nghiệp các cơ cấu thuy khí 
thường có các chuyển động không liên tục, vận tốc thấp và thường gia 
tăng những iực phanh hãm. Bởi vậy khi khảo sát các truyền động thuỷ khí 
trong fav may thường dùng các phương pháp nh. 

Đối với các phương pháp tĩnh năng lượng được biến đổi trực tiếp 
từ thế năng của chất lỏng hoặc chất khí. Do vậy có thể tính lực F (hoặc 
mômen động M) của chất lòng hoặc chất khí tác động lên phần động của 
cơ cấu, tỷ lệ với độ chênh lệch áp suất: 

F=§5(,-p;). (111) 
M=CÓ, -p;). (11.2) 
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với Š - điện tích: C - thể tích. 

¡1,1.1. Các phương trình cơ bản ở chế độ làm việc bình ổn. 

1. Quy luật bầo toàn khót lượng. 

Theo quy luật này thì khối lượng chất lóng hoạc chất khí chuyền 
qua các đoạn ống dẫn chỗ có diện tích S, với lưu lượng q, và chô có diện 
tích S, với lưu lượng q›, đều như nhau, tức là: 

Đ¡ qi = Đ-dq, 

Bởi vì chất lỏng không nén được nên xem mật độ p, = p; = sonst. 

Do vậy, ta có 
Œị Z q; (115) 

Còn đốt với chất khí, mật độ chất khí phụ thuộc vào áp suât, bởi 

thế: 
q.i“q› 
2. Quy luật báo tần năng lượng. 


Theo quy luật này đối với chất lỏng lý tưởng không nén được thì 
trên mỗi đoạn của hệ thuỷ lực (nếu ở đấy không có nguồn bố sung thêm 
hoặc lối thất thoát đi) đều có giá trị năng lượng ứng với mội đơn vị thể 
tích là không đối (phương trình Bemoull). 


s DI -ẻ Hộ 
D 2 ¡— 27 2 
hoặc là: 
Pị+2 Ốt L)= p+2nỐt ) (144) 


Đối với môi trường chất nén được, nhưng nếu chênh lệch áp suất 
gây ra lực nội ma sát là không đáng kể, thì có thể sử dụng phương trình 
trên như phép tính gần đúng. 

3. Tốn thất năng lượng. 


Trong thực tế năng lượng của dòng chất lỏng hoặc chất khí không 
được bảo tồn hoàn toàn vì có tổn thất dọc đường đi hoặc do ma sát với 
thành ống. hoặc do thay đổi dòng chảy v.v... Năng lượng tổn thất 4ø u¿n 
mỗi đoạn ống dẫn có tiết diện không đổi phụ thuộc vào đặc tính của dòng 
chảy: 
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Khi cháy zầng các đường dòng đều song song với thành ống. Tuy 
nhiên chất lỏng thực tế có độ nhớt (đặc trưng bằng hệ số nhớt 1u) cho nên 
khi chuyển động có xuất hiện lực nội ma sát giữa các lớp chất lỏng hoặc 
với thành ống. Bởi vậy sự phân bố vận tốc các dòng chảy là không đều, 
lớn nhất ở chính giữa ống giảm dần ở sát thành ống. Đồng thời cũng đo 
lực ma sát đó mà một phần năng lượng biến thành nhiệt. Năng lượng tổn 
thất này rí lê thuận với lưu lượng: 


Ap + Ru (11.5) 

Ví dụ, đối với ống dân hình trụ chiều dài L thì; 

L 
R = 321m —. 
He) 

Khi chảy rối thì các đường dòng không còn song song với thành 
ống nữa rnà có thể phân bố lung tung xunp quanh một đường trục trung 
bình nào đó với vận tốc u. Sự va chạm giữa các phần tử chất lỏng (hoặc 
chất khí) vớt nhau hoặc với thành ống sẽ sinh nhiệt và làm mất mát năng 


lượng. Năng lượng tốn thất này không phụ thuộc vào hệ số nhớt Ii mà xác 
định bởi động năng của dòng chảy. 


l2 H1” ; 
D= =[ 
Đu Sp( ° )=rq (16) 


với š - hệ số không thứ nguyên. 


Việc chuyển từ chảy tầng sang chảy rối sẽ xảy ra khi lưu lượng q 
vượi quá một giá trị q , ứng với một đại lượng R, không thứ nguyên nào 
đó, R, gọi là số Reynolds. Đối với ống dẫn hình trụ đường kính D: 


_ #pq 
rDụ 


¬ 
I1.1.2. Các phương trình cơ bản ở chế độ làm việc chuyển 
tiếp. 
|. Phương trình trạng thái khi. 


P 
—r=cont l1<k<y 


Phương trình đặc trưng trạng thái nhiệt động học của chất khí là 
phương trình liên hệ giữa mật độ p và áp suất p. 
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Trường hợp k = I quá trình là đẳng nhiệt. Khi chất khí chuyển từ 
trang thái này sang trạng thái khác một cách chậm: chạp thì quá trình trao 
đổi nhiệt với môi trường hoàn toàn thực hiện được và nhiệt độ của chất 
khí xem như không đổi. Việc chuyển tiếp đó ứng với định luật 
Boyle - Marlotte: 


Trường hợp k = y quá trình là đoạn nhiệt. Khi chất khí chuyển 
trạng thái tương đối nhanh thì quá trình trao đổi nhiệt với môi trường hầu 
như không cảm thấy. Việc chuyển tiếp đó ứng với định luật Laplacc: 


: = CONSE 
P 
Đối với khí nén y z 1,404. 
Từ trường hợp chung có thể viết: 
dp _ p dp 


dt pk dt to n 


2, Phương trình lưu hượng 

Khảo sát một bình chứa có thể tích V, chịu áp suất đồng nhất p. 
Gọi q, và q; là lưu lượng ở đầu vào và đầu ra. Điều kiện bảo tồn khối 
lượng bên trong bình giữa hai thời điểm t và t + dt có thể biểu diễn dưới 
đạng: 


pq¡dt - pa;dt = đ(poV) = Vdp 


Từ đó: 
V do 
q;—q;= ø dt 
thay ( ll.7) vào vế phải phương trình ta có: 
ân se V ẻdp 
bó” nkdt khi 


Ở chế độ làm việc bình ổn vế phải của biểu thức (11.8) sẽ bằng 
kaông. 
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3. Độ chịu nén của chất lỏng 

Chất lỏng có thể xem như một môi trường không nén được. Tuy 
nhiên ở nhiệt độ và áp suất nào đó thì mật độ của chất lỏng thay đổi. Có 
thể đánh giá độ chịu nén của chất lỏng bàng hệ số nén thể tích Ð. đụ" 
trưng cho sự thay đổi thể tích tương đối khi áp lực biến đổi một đại lượng 
dp: 


Vì khi thể tích thay đổi một đại lượng đV thì mật độ p cũng thay 
đối một đại lượng đp: 


dV _ dp 
V.p 
Gọi môđun chịu nén B là số nghịch đảo của §: 
Re P5: 
dp 


Như vậy thứ nguyên của B trùng với thứ nguyên của áp suất. 
Thường thường B ~ !500MPa. Khi áp suất tăng thì B tăng chậm, còn khi 
nhiệt độ tăng thì B giảm. Đặc biệt B phụ thuộc vào lượng khí lẫn vào chất 
lỏng. 


Trong trường hợp này phương trình lưu lượng có dạng: 
V dp nh, 
mm." “c 
4. Ảnh hưởng do thay đổi hình học 


Xét phương trình lưu lượng khi thể tích V thay đổi theo thời gian. 
Ví dụ, thay đổi thể tích chứa trong xilanh do vị trí của piston hoặc trong 
ống xếp do sự đàn hồi của ống v.v... Trong các trường hợp đó thì: 


d(pŸ) = Vdp + pdV 
Khi đó thay thế cho biểu thức (1 1.8) ta có: 
+ . 


q2 = (11.10) 


2á9 


dự 


Gọi q,= Eợ? là lưu lượng biến dạng. Trong da số trường hợp thể 


tích các loại xilanh có quan hệ tuyến tính với độ địch chuyển dài hoặc 
dịch chuyển góc 6. 


V=§(x,+x), 
hoặc V=C(8,+ 9). 
dx 
Do vậy: qQạ= đt (H-I1) 
dÔ 
hoặc: qs ST (11.12) 
Từ (11.1), 1.11) và (11.2), (11.12) ta có 
đx 
(P:—P›;)qa = tan trú) 
d9 
(P.—P;)q„ B (114) 


112. TRUYỀN DẪN ĐỘNG KHÍ NÉN 
_11.2.1. Đặc điểm chung. 


Dùng khí nén trong hệ truyền dẫn động robot có nhiều thuận lợi. 
Trước hết do các phân xưởng công nghiệp thường có mang lưới khí nến 
chung, cho nên đơn giản hoá được phản thiết bị nguồn động lực cho 
robot. Vì khí nén có thể xả ra không khí nên không đòi hỏi hệ thống đưa 
khí nén trở lại như đối với dầu ép. Hệ thống truyền dẫn khí nén tương đối 
gọn nhe, dễ sử dụng, để đảo chiều và không quá nhạy với nhiệt độ khi 
làm việc. . 
Tuy nhiên; dùng hệ truyền dẫn khí nén cũng không ít nhược điểm. 
Trước hết là do đặc điểm nén được của chất khí cho nên chuyển động do 
chúng thực hiện thường kèm theo đao động, không chính xác lúc 
dừng,nhất là ở các vị trí trung gian. Ngoài ra còn cần có biện pháp phun 
dầu bôi trơn, lọc bụi, lọc ẩm và giảm ồn. 


Môdun truyền dân động khí nén cho một bậc tự đo của cơ cấu tay 
máy thường bao gồm các bộ phận chủ yếu như động cơ, bộ phận phân 
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phối. bọ phận điều chỉnh vận tốc. Các phần tử và thiết bị khí nén đều 
được tiêu chuẩn hoá. Bảng dưới đây giới thiệu các phần tư, thiệt bị chủ 
vếu của hệ thống truyền đẫn động khí nén và các ký hiệu cơ bản. Ngày 
nay đã có những chương trình máy tính vẽ các phần tử và các mạch khí 
nén. Dưới đây ta sử dụng các chương trình đó. 


.l1,2.2. Các bảng ký hiệu và tên gọi các phần tư và thiết bị khí 


Bảng I1]1.1. Các £hiết bị chuyển hóa năng lượng 


N" ] Tên phần tử và thiết bị Sơ đồ 


¬1 


L | Máy nén khí 


2_ | Bơm chân không 


3 | Động cơ khí nến tốc độ 
không đổi với một dòng 
khí 


4 | Động cơ khí nén tếc độ 
không đổi đối với hai 
đòng khí 


5| Động cơ khí nén với thể 
tích chuyển dịch điểu 
chỉnh được một đòng khí 


| Oioloo 
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tiếp bảng lL.] 


IN'|_ Tên phần tử và thiết bị Sơ đồ 
EƑ IV 


6 | Động cơ khí nén với thể 
tích chuyển địch điểu 
¡ chỉnh được hai dòng khí ] 


7 | Xianh tác động đơn, = 
chuyển động lùi nhờ lực #` l8 


bên ngoài. 


SẼ —† 


8 |Xianh tác động đơn, A2 


chuyển động lùi nhờ lò 
Xo 


ị ' 


9 ¡ Xianh tác động kép với I== 


piston một đầu cần 


| 


10 | Xianh tác động kép với == 


pIston hai đầu cần 
li | Xanh vi sai với piston  =—=i 
một đầu cản 


12 | Xilanh tác động kép hai | | 
đầu có gối đệm điều ? 
chính được 
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-Bảng lJ.2. Cøc thiết bị điều chín h nồng lượng 


Các van điều khiển hướng 


1 | Van dẫn hướng 2/2 thường 


đóng 


2 | Van dân hướng 2/2 thường mở 


| đóng 


A 

F) 

4 
Hhì 

A 
3 Van dân hướng 3/2 thường IBN 
#{ |# 

A 


4| Van dân hướng 3/2 thường mở 


5 | Van dẫn hướng 3/ 3 ở vị trí 6i 
giữa đóng 
La l. 


6 | Van dẫn hướng 4/2 


7 | Van dân hướng 4/3 vị trí giữa 


đóng 


VI) 


tiếp bảng 1J.2 


= Ị l TT 

M Các van điều khiển hướng Sơ đã 

Z1 JA | 

3 | Van đãn hướng 4/3 vị trí thả 
| ‡ nối nh | 
_— = 

§ 3 A 

ị 

9| Van đẫn hướng 5/2 
I 


® ˆ $ 


=_———— 


ø A 
10 | Van dẫn hương 5/3 vị trí giữa L4 
đóng lị 


N. Vạn một chiều: Sơ đồ 


| Van khoá không lồ xo (O 


Van khoá có lò xo = VVV 
Lò sả, 
E) Van khoá phụ trợ “ol— 
la 
4 Van con thoi đi sÍ 


5 Van xã nhanh 


he 
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Tiếp bảng 11.2 


l0 


Vứn chêH áp 


tác động cơ học chống lại lò 
xo tỰ hồi 


: Van khống chế áp. điều chỉnh 
được 
~] - 
2+1 và 
“ ] Van đặt nốt tiếp, điệu chịah 
Ị được, có lỗ xả 
Ầ 7 Ị 
` Van chính áp không lỗ xả, 
điều chỉnh được 
| 4 h 
Van chính áp, có lỗ xã, điểu 
chính được 
N' Van nét la 
L | Van tiết lưu với mức khống Xà z⁄ 
2 Van màng với mức khống ché V 
knâng đổi ^ 
3 |] Van tiết lưu điều chỉnh được. 
lác dộng bất kì 
_—® 
4_ | Van tiết lưu điều chính được, 
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" 


Van đáng kín (Van khoá) 


Tiếp bảng. tH2 


Sở đô 


II 


Van đóng kín, biểu điễn đơn 
giản hoá 


Van tiết híu với van khoá mắc 
song song 


Jb 
R Í Van tràn điều chính được 


NO 


Van màng trần, điểu chính 
được 


Nguôn truyền năng lượng: 


1 ] Nguôn ấp suất 


2_ ¡ Đường làm việc 


L 
3 | Đường điều khiển 


4Ì Ống dân mềm 


5 len điện 


Điểm nối (cố định) 


Các đường giao nhau 


8 | Điểm xả 


9 | Lễ ra không nối ống dân 
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N' Nguồn truyền năng lượng ˆ Sơ đả 
| }Ø_ ] Lã ra có nối ống đẫn 
" 
=“— ———_-_---| 
II Điểm trếp nốt với á? suất đã 
dóng : : 
==...... 
¡| Điêm tiệp nối với ấp suất có 
đường nối Hi 
| Khớp nối ngát nhanh. đã tách. ` ( 
¡13 van đóng kín ống dân. 
Khớp nối ngất nhanh đã tách, |. œ ( 
Độ ống dẫn đóng 
15 Thiết bị giảm âm —1') >> 
!Ó Í Bình ích khí -ÝC_ >*È 
17 Bộ lọc | _—<?>— 
I) Bộ phân ly nước thao tác bàng 
tay 
l9 | Bộ phân ly nước thoát nước tự 
động 
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Tiếp bảng 11.2 


„ đệ 
w' Nguồn truyền nãng lượng S đồ 
5 | 
201 Bộ lọc. phân ¡1 nước tự động | 
len 
21 | Thiết bị sấy 


c— 
<> 


22 Thiết bị bôi trơn | 
| 
Thiết bị phụ trợ (bộ lọc, van Ị 
23 | chỉnh áp. thiết bị bói trơn, áp @ 
kế) biểu điễn đơn giản hoá h 
| 
24_ | Thiết bị làm mát 


<‹> 


Bảng 11.8. Các phương tiện tác động 


"Thiết bị điều khiển bằng ray, chân 


Ký hiệu 


1 | Chuông | 
: | 
| LL/2T— ] 
3 | Tay cảm Lọ, 
4 | Bàn đạp =- 
_——— ) 


Tiếp bảng 11.3 


— 


| N' Điền khiển cơ | Ký hiệu 
| ị 
1 
L : 
: Lò xo Ị \ / \ /\ | 
`. 
3 : Ỗ - 
Cân con lăn 
s T 
: Cần con lăn tự hồi l7 
NP Điệu khiển điện Ký hiệu 
ị 
1 ~“ vội 
Ông đây I1 cuộn tác dụng 


Ống đây 2 cuộn rác dụng 
ngược chiều 


_— 
H_ 


N° Điều khiển khí nén Ký hiệu 
: Trực tiếp bằng tràn áp = 
— 
2 : ` 
Trực tiếp bằng tràn áp THỊ — 
3.1 sở TY, › Ta. 
Gián tiếp bảng cấp áp = 
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Tiếp bảng II 3 


F— H T— 
ELMN h4 Điều khiển khí nen Ký hiệu : 
Gián tiếp bằng tràn áp - —_ 
N' Điều khiển kết hợp Kỷ hiệu 
lÌ 
l |Ống đây Và van điều khiến | Em _ 
T¬ 
| ị 
2 | Ống đây hoặc van điều khiển ¬ 
3 Ống đây hoặc van điều ¬ | 
bằng tay có lò xo tự hồi 
—————— ——————— —————— 
N° Cúc ống nãi Ký hiệu 
T IS ¬Ì 
. Các đường làm Việc A,B.C.... 
J 1 
| 2 | Đường tiếp khí, tiếp nối khí P 
| xo R.S.T... 
À1 
3 Điểm thải, xả L 
4 | Đường điều khiển Z.Y.X... | 
| 


11.2.3. Tính toán và chọn lựa xilanh khí nén. 


Khi thiết kế hệ thống truyền dẫn động khí nén thì xilanh là phần 
tử cần phải tính toán nhất. Gọi chung tên gọi là xiianh cho cả 2 trường 
hợp năng lượng khí nén được chuyển thành chuyển động tịnh tiến hoặc 
chuyển động quay. Trường hợp thứ 2 còn gọi là xilanh quay hoặc động cơ 
khí nén (pieumatic motor). 


Trong..bảng I‡] zó loại xanh tấc động đơn (single acting 
cylinder) và xilanh tác độn» kép (double actng cy]inđer). 
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Trong các xilanh tác động đơn, khí nén vào một phía đẩy piston 
theo chiều ngược lại, trở vẻ vị trí ban đầu với tôc độ đủ nhanh. Hành trình 
của piston phải nhỏ hơn hoặc bằng chiều đài của lò xo khi chưa bị nén. 
Các xilanh đơn cũng có nhiều kiểu khác nhau tuỳ theo công dụng. Các 
loại xilanh đơn dùng chủ yếu kẹp, phun, nén, nâng và cấp liệu v.v... Lớp 
vật liêu phủ ngoài piston. ví dụ như tefton, đảm bảo vừa kín khít. vừa ít 
ma sat và lâu mòn. 

Trong các xilunh tác động kép, khí nén có thể đẩy piston chuyển 
động tịnh tiến và cả chuyên động lùi. Hành trình piston không bị hạn chế - 
nhưng phải tính tới tốc độ uốn võng của cần piston. 


Xilanh tác động kép có loại piston với I đầu cần hoặc 2 đầu cần. 
Loại 2 đầu cần là loại cần piston kéo dài cả 2 phải chạy dọc suốt chiều 
đài xilanh. 

Loại này có nhiều ưu điểm như: 


- Lực tác động bằng nhau ở cả 2 chiều chuyển động vì diện tích 
hữu ích của piston ở 2 phía đều như nhau; 


- Có thể chịu được tải ngang nhỏ vì cần piston xem như một trục 
lắp trên 2 ổ tựa. 


Xilanh tác động kép thường có kết cấu 2 đầu có giám chấn điều 
chỉnh được. Đề tránh va chạm mạnh, nhất là khi dịch chuyển khối lượng 
lớn, người ta tạo ra những cái đệm ở vị trí cuối hành trình. Khi đến vị trí 
cuối, piston đệm chặn đường ra của khí nén và thay vào đó có một lễ 
thoát rất nhỏ điều chính được. Khí nén ở phần cuối xilanh được nén và 
thoát ra từ từ qua van tiết lưu một chiều. Vì thế piston chuyển động từ từ 
đến vị trí tận cùng. 


Có loại xilanh tiếp đôi và xilanh nhiều vị trí. 


Cơ cấu xiianh tiếp đói gồm 2 xilanh tác động kép, ghép nối tiếp 
nhau tạo thành như một khối duỹ nhất. Khi tác động đồng thời thì lực trên 
cần piston tăng gấp đôi. Người ta dùng loại xilanh này khi cần lực lớn mà 
đường kính xilanh bị giới hạn. Hình 10.1 là sơ đồ cơ cấu xi]lanh tiếp đôi. 


Hinh 11.1. 
- Xilanh tiếp dôi 
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Hình 11:2. Xilanh nhiều uị trí 


Xilanh nhiều vị trí gồm 2 hoặc nhiều xilanh tác động kép ghép nối 
tiếp nhau. Tuỳ theo từng xilanh hoạt động riêng rẽ mà tổ hợp chúng SẼ 
đạt được nhiều vị trí khác nhau. Với 2 xilanh, như hình 11.2, có 4 vị trí 
khác nhau. Loại xilanh nhiều vị trí thường được dùng để phục vụ cấc cơ 
cấu phân loại sản phẩm. Ở mỗi vị trí ứng với mỗi loại sản phẩm. 


Để thực hiện nhiều vị trí còn có thể đùng các xilanh lồng tác động 
đơn (hình LŸ}3a) hoặc tác động kép (hình !¡ 3b). Chúng có kết cấu như là 
các xilanh lồn ø vào nhau. 
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Hinh !I.3. Các xilanh lồng. 


Các xilanh quay có sơ đồ kết cấu tương tự như một roto cánh gạt 
nằm trong một thân hộp kín. Khí nén đưa vào trong thân hộp làm roto 
quay. 


Chuyển động quay có thể tạo ra từ các xilanh tịnh tiến tác động 
kép. Trong trường hợp này trên một đầu hoặc một đoạn cần piston được 
tạo hình như thanh răng hoặc trục vít, ăn khớp với bánh răng hoặc bánh 
vít. Góc quay có thể thay đối theo thông số ăn khớp bánh răng. Thường 
dùng các góc quay 45", 90', 180”, 270” đến 720”. Loại này được dùng 
trong các khớp quay của robot, trong cơ cấu đóng mở van v.v... 


Tính toán lực piston 


Lực tác động vào piston phụ thuộc vào ấp suất khí nén, đường 
kính trong của xIanh và ma sát ở các bộ phán tiếp xúc động: 


F.=A.p (I.15) 
với F, - lực piston lý thuyết (N) 
Á_- diện tích hữu ích của piston (m”) 
..P - ấp suất làm việc (Pa) 
: Trong thực tế còn có lực ma sát nên lực piston hiệu dụng F, sẽ là: 


- Đối với xanh tác động đơn: 


F,= A.p- Œ,+E). (Ï:16) 
- Đối với xilanh tác động kép: ì 
Khi tiến: F,=A.p-E, (3.17) 
Khi lùi: F,=A'p-E, (LÊ18) 
Trong các công thức trên: 
xa D7 
¬ 4 (m?) 


lá 
œ 
G2 


,_ 1D ”~dŸ) 
ng GUI.... 
F, - lực lò xo phản hồi (N) 
F¡- lực :na sắt (N), thường F; = (3% + 2022) F. 
Ð - đường kính trong của xanh (m) 
đ - đường kính của cần piston (m) 
Vận tốc của piston 


Vận tốc di chuyển của piston là hàm của áp suất khí tác động lên 
bẻ mặt piston, lực cần do ma sát giữa piston và mặt trụ trong xilanh và sự 
giảm chấn cuối hành trình v.v... Vận tốc piston thường thay đổi từ 0,I đến 
1,Sm/s. 

Tính lưu lượng khí 


Có thể dùng các giản đồ lập sắn của hãng sản xuất để tính ]ưu 
tượng khí, hoặc tính theo các công thúc sau: 


- Đối với xIlanh tác động đơn: 


dỶm 
Q =Sn. Đi HÉx gả (11.19) 
- Đối với xilanh tác động kép: 
2 *. xi2 
Q= SinnC—- tên VỆ (11.20) 


Á p 
Trong đó: 
Q - lưu lượng khí (1/phút) 
S - hành trình piston (cm) 
n - số hành trình trong 1 phút 
K, - tỷ số nén 


Ty số nén được tính theo công thức sau: 


_ ]0I,3 +áp suất cung cấp (KPa) 
W LÓI, 3 
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11.2.4. Sơ đô và phương pháp cấu tạo mạch khí nén. 
Người ta đùng 2 phương pháp cấu tạo sơ đồ mạch khí nén: 


Theo phương pháp thứ nhất các sơ đồ mạch khí nén được cấu tạo 
chủ yếu dựa trên cơ sở kinh nghiệm với trực giác của người thiết kế. 
Phương pháp này đòi hỏi tích luỹ kinh nghiêm, phân tích mức độ phù hợp 
của những sơ đồ tương tự trước đây mà quyết định giải pháp. Trong 
trường hợp này ảnh hưởng chủ quan của người thiết kế thường kköng 
nhỏ. Tuy nhiên trong thực tế đôi khi các giải pháp như thế là cần thiưt và 
phương pháp này vân được áp dụng như một phương pháp truyền thống. 


Theo phương pháp thứ hai, còn gọi là phương pháp "hệ thống 
tầng" sơ đồ được cấu tạo từ các mạch cơ bản một cách lôgic. Chỉ khi nào 
các mạch cơ bản đám bảo chức năng hoạt động thì mới xem xét đến các 
yêu cầu khác. Những yêu cầu này được xem xét kết hợp với nhâu Và Sơ 
đồ mở rộng từng bước mội. 


Bố trí sơ đồ mạch 


Các bộ phận truyền động 


Theo Các xilanh 


thông lệ bộ 
phận cung cấp 
năng lượng 
được vẽ ở phía 
dưới và đồng 
năng lượng 
được phân bố từ 
dưới lên. Các 
phần tử, các van 
dân hướng và cả 
xilanh đều vẽ ở 
tư thế nằm 
ngang. 


Tín hiệu ra 


| Các bộ phận điều khiển 
Van dẫn hướng 


Xử lí tín hiệu 


Các bộ phận xử lý 


-Ì 


Các bộ phận tín hiệu Tín hiệu vào 


Cung cấp nâng lượng 


Hình 11.4. Cách bố trí sơ đồ mạch 
xÂ 


rên 
hình 1Ï.4 biểu 
thị sự phân bố 
từ dưới lên trên: 


Nguồn năng lượng 


Trên hình LÍ.5 #šgmột sơ đồ mạch khí nén theo cách bố trí nói 
trên. ở đây người ta yêu đấu“là khi ấn nút bấm hoặc bàn đạp thì cần pIston 
sẽ chuyển dịch sang trái đến vị trí tận cùng tác động lên van V, đặt ở đó 
sẽ làm nó trở lạt vị trí xuất phát. 
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Tuy nhiên trên thực tế V, đặt ở vị trí tận cùng khi đầu cần piston 
van chuyên dịch tới nhưng trên sơ đồ lại bố trí ở hàng các ¡-^ In hiệu. 


| 
„ILIM 


Hình 11.5. Sơ đổ mạch f-hí nén 


Các ký hiệu 
Có thể ký hiệu các phần tử của hệ thống sơ đồ bằng chữ số: 
Ký hiệu các nhóm: 

Nhóm 0- nhóm năng lượng 

Nhóm I, 2. 3... đối với mỗi xilanh là một nhóm số. 
Ký hiệu các nhánh: 

Ô- các bô phận trên nhánh đường làm việc. 

I- các bộ phận trên nhánh đường điều khiển. 


2, 4 (số chân) - các bộ phận trên nhánh đường làm chuyển 
dịch piston về phía trước. 


3, 5 (số lẻ) - các bô phận trên nhánh đường làm chuyển dịch 
piston về phía ngược lại. 


286 


01,02 .v...v. - các bộ phận khác nhau trên nhánh đường làm: 
VIỆC. 
Hình 14:6 mính hoạ cách kí hiệu bằng chữ số trên một sơ đồ mạch 
khí nén. 


3 
| [2/2 


2 


HÍ/JAe + 


a7 


^ 


Hình 11.6. Ký hiệu bằng chữ số trên sơ đồ mạch 
Có thể ký hiệu bằng các chữ cái kết hợp với chữ số: 


Các xilanh truyền động được ký hiệu bằng chữ in hoa, các bộ 
phận tín hiệu được ghi bằng chữ thường, ví dụ. hình 11.7. 


A,B.C... định danh cho các xilanh. 


dạ, bụ, cụ,... định danh các công tắc hành trình ứng với các vị trí đầu 
của các xilanh A, B, C... 


a;, b,,c,,... định đanh của các công tắc hành trình ứng với các vi trí 
xác định của đầu cần piston của các xilanh A, B, C 


SỐ cày. llệc =4 
Hình 11.7. Ký hiệu chữ E===ỈI 
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Vẽ các đường làm việc bằng nét lên, còn các đường điều khiển 
bằng nét đứt. 


Các thiết bị trong sơ đồ mạch thường được biểu thị ở vị trí khởi 
động điều khiển. Nếu không, phải có ghi chú thích hợp. 


Trong các van có thể hồi đảo (ví dụ, bằng lò xo) thì vị ứrí ï!:⁄ờng 
được định nghĩa là vị trí ứng với phần động lúc van không được ghép nối. 
Còn vị trí ban đầu là vị trí ứng với phần động khi đã ghép nối với nguồn 
nàng lượng. 

Trên hình I !.§ biểu thị một van 3/2 tác động bằng nút bấm và một 
công tắc hành trình ở vị trí thường, được vẽ ở vị trí khởi động. 


: -[R 


Ñ 


Hình 11.8. Van 3⁄2 uà công tắc hành trình. 
11.2.5. Các mạch khí nén cơ bản. 


Phần trên đã nói tới sự đa dạng trong các phương cách thiết kế sơ 
đồ mạch khí nén. Tuy nhiên chúng có những điểm chung, ví dụ, đều gồm 
các mạch cơ bản và từ các mạch cơ bản có thể cấu tạo nên nhiều sơ đỏ 
khí nén khác nhau. 

Dưới đây sẽ khảo sát các mạch cơ bản dưới dạng các bài tập riêng 
lẻ. 

Điều khiển xanh tác động dơn 

Nhiệm vụ: 

Cần chuyển dịch piston của một xilanh tác động đơn . Khi không 
có tác động nữa thì piston trở lại ngay vị trí ban đầu. 

Giải: 

Dùng một van dẫn hướng 3/2 thường đóng (hình 11.9). Khi van 
này được tác động, khí nén chạy từ P đến A và ống xả R bị đóng kín. 
Việc hồi đảo bằng lò xo làm cho buồng xilanh xả khí từ A đến R và lúc 
này cửa P lại bị đóng. 
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Hình 11.9. Điều khiển xilanh tác động đơn 
Điều khiển xilanh tác động kép 
Nhiệm vụ: 


Piston của một xilanh tác động kép cần chuyển dịch đi và chuyển 
dịch lại. 


Hình 1 Ï.10. Điều khiển xilanh tác động kép. 
Giải: 


Nhiệm vụ có thể thực hiện được bằng van dẫn hướng 4/2 hoặc 
van dẫn hướng 5/2 (hình I I.!0). 


Piston đang ở vị trí tận cùng phía sau, lúc đó khí thông từ P đến B 
và từ A đến R trong van dẫn hướng 4/2. 
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Khi tác đông vào nút bấm của van. phản động chuyển dịeh tới vị 
trí làm thông đường khí từ P đến A và từ B đến R. Vị trí piston sẽ dược 
chuyển địch lên bhía trước đên vị trí tận cùng. 


Thôi tác động vào nút bấm, lò xo tự hồi làm cho piston trở về vị trí 
ban đầu. - 


Với van dẫn hướng 5/2, khí xả lúc qua cửa R, lúc qua cửa 5S. 
Điều khiển dùng van con thai 
Nhiêm vụ: 


Tạo sư chuyển dịch của piston xilanh được tác động từ 2 điểm 
khác nhau (hình 11.11). 


Hình 1 1.1 1. Điều khiển dùng nan con thoi. 


Giải: 

Khi tác động lên van 1.2 khí nén đi từ P đến A và cũng đi từ X 
đến A trong van con thoi rồi đến xilanh. Quá trình này cũng diễn ra tương 
tự khi tác động lên van 1.4. 


Nếu không dùng van con thoi thì khí có thể lọt ra ngoài qua lỗ xả 
của van hồi dẫn 3/2 khác, ví dụ, van I.2 hoặc van 1.4 khi nó hoạt động. 


Điều chỉnh tốc độ trên xilanh tác động đơn: 


Nhiệm vụ: 
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Tốc độ của piston trong xilanh tác động đơn cần được điều chỉnh 
khi piston chuyển động tiến. 


Giai: 
Với xilanh tác động đơn chuyển đàng tịnh tiến của piston chỉ có 


thể giảm bằng cách dùng tiết lưu để cấp œiêm hoặc giảm bớt luồng khí 
cung cấp. 


Hình 11.12 biểu thị tiết lưu khí nén cung cấp cho chuyển động 
tịnh tiến của pison. 


Niiệm vụ: 


Tốc độ của piston cần được điều chỉnh khi li, 


Hình1 1,12. Điều chỉnh tốc độ khi tiến  Hình1ƒ.14. Điều chính tốc độ khi lùi 
Giải: 
Chỉ có thể thực hiện được bằng cách điều tiết xả khí (hình I F13). 
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Nhiệm vụ: 


Tốc độ của piston trong xilanh tác 
động đơn điều chỉnh và được tiết lưu riêng 
rẽ trong chuyển động tiến và lùi. 


Gz¡: Trong trường hợp này cần sử 
dụng 2 van tràn đề thực hiện việc điều chỉnh 
riêng ¡c và chính xác (hình 11.14). 


Điều chỉnh tốc độ trên các xilanh 
tác động kép: 


Nhiệm vụ: Điều chính tốc độ tiến và 
lùi của piston x¡ilanh tác động kép. 

Giải: Có 2 phương án: 

a) Tiết lưu khí xả (hình [T.15) có 
thể điều chỉnh một cách riêng rẽ cho các 
chuyển động tiến và lùi. Thoạt đầu chuyển 
động không điều hòa lắm cho tới khi cán 
bằng lực, nhưng sau đó có khả năng điêu 
chỉnh tốt hơn (không phụ thuộc vào tái). 


Hình 11.14. Điều chỉnh 
tốc độ dùng hai uan trăn 


Với van dẫn hướng 5/2 có thể lắp các bộ tiết lưu đơn giản tại chỗ 
nối ống xả khí. 
b) Tiết lưu khí vào (hình LI.16) có thể điều chỉnh riêng rẽ được 


}2 ;ô 


Hình E1ˆ15. Tiết lưu khí xả 
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‹.:o các chuyển động tiến và lùi. Chuyển động ban đầu khá điều hoà 
hưng ít khả năng điều chỉnh. Không dùng cho trường hợp chịu tải kéo 
cảng. Thường dùng cho các xilanh có thể tích nhỏ và hoạt động ngược lại 
với tải, 


* 


Tầng tốc trong các xilanh tác 
động đơn và kép. 

Nhiêm vị 

Cần táng tốc độ lìi của piston 
và trong xilanh tác động đơn. 

Giải: 

Van xả nhanh được sử dụng đế 
tăng tốc độ của pision trong xilanh 
(hình II.17). Điều đó cho phép tránh 
được thời gian hồi đảo kéo dài nhất là 
đối với các xilanh tác động đơn. 


Hình 11.17. Tăng tốc của piston Hình 11.18. Tăng tốc của 
trong xi lanh tác động đơn piston trong xilanh tác động kép 
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Nhiệm vụ: Cần tăng nhanh tốc độ tiến của piston trong xilanh tác 
động kép. 

Giải: Thiết kế mạch như hình LÝ 1§. Khi van 1.1 chuyển vị. để khí 
nén phải hết sức nhanh chóng thoát khỏi buông phía trước của xilanh có 
thê lăp một van xả nhanh ngay sát với x1lanh và cho khí thoát ngay ra khí 
quyền. Khôóng cần thiết phải xả khí qua suốt chiều đài ống dẫn và van. 

Điều khiển bằng van song áp: 

Nhiệm vụ: 

Cần piston của xilanh tác động đơn được chuyển động chỉ khi 2 
van dẫn hướng 3/2 tác động đồng thời. 

Giải: Có 2 cách: 

a) Dùng van song áp (hình 11.19): khi cùng tác động hai van 1.2 
và 1.4 tạo ra các tín hiệu X và Y vào van song áp. Do vậy theo cửa Á của 
van song áp khí nền sẽ vào xilanh tạo cho piston chuyển động. 


Hình 11.20. Ghép nổi riếp 2 uan 


Hình 11.19. Điều khiển uan song ép 


b) Ghép nối tiếp hai van 1.2 và 1.4 (Hình 11.20). Khi chúng cùng 
được tác động thì khí nén sẽ được cấp vào xilanh. 


Điều khiển gián Hếp các xilanh tác động đơn. 


Nhiệm vụ: 


294 


Piston của một xilanh tác động đơn có dung tích lớn (đường kính 
lớn, hành trình đài. ống dẫn đài) cần phải chuyển động sau khi tác động 
vo van điều khiển và lùi lại ngay vị trí tận cùng sau khi nhả van đó ra. 


Giải: 


Thiết kế sơ đồ như kề: 
hình LI.2I. Tác động vào 
van 1.2 làm cho khí chạy 1ừ 
P đến A và trên van !.! xuất 
hiện tín hiệu Z làm van 1.1 
chuyển vị. Vì vậy thông 
đường dẫn từ P đến A và 
piston sẽ chuyên động. 


Điêu khiển các mạch 
thời gian 

Yếu tố thời gian 
thường phải xét đến khi xử lí 
các thông tin lúc chuyển 
mạch, thông thường ở các vị 
trí tận cùng của piston 
xIlanh. 


Đề thực hiện việc Hình 141.21. Điều khiển gián tiếp 
chuyển mạch có thể dùng ' các xilanh tác động đơn 
"các phần từ khí nén điều 
khiển thời gian” (p-pneumatic time control element). Các phản tử này có 
thể tạo thành một cách đơn giản bằng cách kết hợp các van dân hướng, 
van tràn và bình tích. Có thể nối ghép trong mạch các chỉ tiết đơn lẻ này 
hoặc dùng các đơn nguyên có sẵn đã chứa trong mình các chi tiết này. Đó 
là các van tác động chậm (time delay valve). 


Van tác động chậm gồm một van dẫn hướng 3/2, một van tràn và 
một bình tích. Van này chia làm 2 loại: van mở chậm và van đóng châm. 


Van mở chậm thường đóng: 


Trong sơ đồ L 1.22, phần tử 1.3 là van mở chậm thường đóng. Khí 
nén đi vào cửa Z qua van tràn và tuỳ theo mức điều chỉnh của vít tiết lưu 
mà một lượng khí nhiều hay ít trong một đơn vị thời gian sẽ đi vào bình 
tích. Khi áp suất trong bình đã lên đến mức cần thiết thì làm chuyển vị 
van dân hướng 3/2 thường đóng. Nó bịt lối thoát khí từ A đến l. Thời 
gian cần thiết để tăng áp suất trong bình bằng thời gian tác động chậm 
của van. Nếu muốn van tác động chậm quay bại vị trí ban đầu thì cửa 
điều khiến Z phải được xả khí. Khí sẽ đi từ bình tích chạy qua khí quyển 
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qua van tràn, ống xả và lò xo nén sẽ làm chuyển vị van trượt. Cửa P đóng 
lại, đường thoạt khí từ A đến R được thông. 

Trên hình I 1.22 là ví dụ các phương án sơ đồ mạch khí nén dùng 
van mở chậm để duy trì vị trí tàn cùng trước cuả piston xilanh trong một 
khoảng khắc nhất định. 


Hình 11.22. Mạch khí nén dùng uan mở chậm thường đóng. 
Vam đóng chậm thường mở: 


Phần tử 1.4 trong sơ đồ 11.23 là van mở chậm thường mở. Ở đây 
cũng vậy, khí điều khiển tác động vào cửa Z. Khi áp suất điều khiển đã 
đạt được mức cần thiết trong bình tích thì làm van dẫn hướng 3/2 chuyển 
động ngược lại. Khi đó dòng khí từ P đến A được khoá lại và đường xả 
khí từ A đến R được thông. Thời gian tác động chậm tương ứng với thời 
gian cần thiết để tăng áp suất trong bình tích. Nếu khí được thoát ra khỏi 
cửa Z, thì van đân hướng 3/2 lại quay lại vị trí ban đầu. 

Hình 11.23 là ví dụ sơ đồ mạch khí nén dùng van đóng chậm. 

Đối với cả 2 loại van này thời gian tác động chậm thường từ 
0 + 30 giây. Bằng cách sử dụng thêm các bình tích phụ, có thể kéo dài 
thời gian tác động chậm này. Mức độ chính xác về thời gian lại còn phụ 
thuộc vào độ sạch và sự ồn định áp suất của khí nén. 

Thông thường người ta không yêu cầu cao về độ chính xác thời 
gian đối với các loại mạch khí nén này. Song quan trọng là tạo ra độ lệch 
pha các chuyền động. 
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Hình 11.23. Mạch khi nén dùng an đóng chậm thường mở. 


Ví dụ điều khiển chuyển động phối hợp nhiều xilanh 


Nhiệm vụ: Các kiện hàng, chuyển đến trên băng tải con lăn, được 
nâng lên bằng xilanh khí nén A và được xilanh khí nén B đây sang một 
băng tải khác. 


Giải: 
Hình 1 L.24 là sơ đồ vị trí các xilanh khi thao tác 


Như vậy, xilanh B chỉ có thể thực hiện chuyền động đảo chiều lại 
khí xHanh A đã lùi về vị trí tận cùng sau. 
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Hình 11ˆ24. Sơ đồ phối hợp 2 xilanh 
Hình 1 1:25 là sơ đồ các bước chuyển vị của 2 xilanh A và B. 


Hình 11.25. Sơ đỏ các bước chuyến uị. 


Hình 1 1.26 là một phương án thiết kế sơ đồ mạch khí nén. 


27 23 *2 z3 22 


+! 


+2 r3 z2 zã 
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Hình 11.26. Sơ đồ mạch khí nén phối hợp 2 xilanh (phương ún 1) 


Nói chung, tiến trình thiết kế sơ đỏ mạch khí nén phụ thuộc nhiều 
vào cách ngất tín hiệu. Có thể kiểm tra trên sơ đồ chuyển vị và điều khiển 
trên hình 11,27 xem ở chỗ nào cần ngắt tín hiệu. 


Hình 11.27. Sơ đồ chuyển uị uà điều khiển ngắt tín hiệu 
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Như thấy trên hình 1 l2? đối với sơ đồ mạch này không cần có 
ngất tín hiệu với điều kiện là bộ phận tín hiệu 1.2 không phát tín hiệu ra 
trước bước 3 nữa. Vì bộ phận tín hiệu này điều khiển bảng tay nên có thể 
điều kiện này không nhất thiết phải thể hiện trên sơ đồ mạch. 

Khi kiểm tra phải đảm bảo sao cho không có tín hiệu khác tác 
động đồng thời vào cùng một xHanh bởi vì có thể tín hiệu này lại ngăn 
cản tín hiên kia. 

Cách ngăt tín hiệu đơn giản và tin cậy là bố trí các van điều khiển 
cân con lăn ở các vị trí cuối hành trình của cần piston như hình 1 1.28. 


Hình 11.28. Sơ đồ mạch khí nén phối hợp 2 xilanh (phương án 2) 


Trên sơ đồ mạch hình 11.29 có lắp thêm một van ngắt tín hiệu 1.4 
ứng với vị trí cuối hành trình lùi của piston xilanh B. Bằng cách dùng các 
khoá liên động đó, mạch đảm bảo hoạt động bình thường tronp toàn bộ 
chu trình làm việc ngay cả khi van 1.2 hoạt động. 
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Hình 11.29 Sơ đổ mạch khí nén phối hợp 2 xilanh (phương án 3) 


11.3. TRUYỀN ĐẪN ĐỘNG THUỶ LỤC 
11.3.1,. Đặc điểm chung 


Hệ truyền dẫn thuỷ lực có nhiều ưu điểm, chủ yếu là: gọn nhẹ, 
chịu được tải nặng, quán tính bé. Để thay đổi chuyển động người ta dùng 
các van điều chỉnh áp lực và lưu lượng, tương đối thuận tiện khi sử dụng. 


Tuy nhiên chúng cũng có không ít nhược điểm. Trước hết là hệ 
thuỷ lực luôn luôn đồi hỏi có bộ nguồn bao gồm bơm thuỷ lực, thiết bị 
lọc, thiết bị điều chỉnh áp suất, thiết bị làm mát, bình tích đầu v...v. Ngoài 
ra hệ thống kiểm tra đường ống, các đường hồi dầu và thùng đầu cũng 
làm phức tạp thêm cho hệ thiết bị thuỷ lực dùng trong tay máy. Nhiệt độ 
làm việc có ảnh hưởng nhiều đến độ nhớt và áp suất của dầu ép. 


Nhìn chung, hệ truyền đẫn thuỷ lực trong tay máy vẫn được sử 
dụng rộng rãi hơn cả, nhất là trong trường hợp tải nặng. Hệ truyền dẫn 
thuỷ lực đùng trong tay máy có những yêu cầu cao về độ chính xác, ma 
sát thấp, giảm độ chênh lệch giữa ma sát tĩnh và.raa sát động để tăng độ 
nhạy mỗi khi dừng hoặc thay đổi chuyển động, tăng mức điều hoà làm 
việc nhất là khi chuyển dịch chậm. Về tốc độ làm việc đòi hỏi thay đổi 
với phạm vi rộng và nhanh. Vẻ kích thước đòi hỏi gọn nhẹ độ cứng vững 
Cao, V...V. 


Đối với tay máy truyền dẫn thuỷ lực thường áp dụng hệ điều 
khiển theo vị trí hoặc theo chu vi kép kín (chu tuyến). 
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11.3.2. Truyền động thuỷ lực 


Xilanh tịnh tiến dùng dầu ép cũng tương tự như xiIlanh tịnh tiến 
dùng khí nén. nhưng gọn nhẹ hơn nhiều khi có cùng một cỡ công suất. 
Trên hình 1.30 là sơ đồ kết cấu của xilanh thuỷ lực tác động hai phía với 
hai buồng áp suất p, và p;. Bởi vì cần piston có tiết điện ngang là s nằm 
về một phía nén tác đụng vào pïston từ hai phía là không đối xứng. 


E=(S+s)p, - 5p; (11.21) 


Hình 11.30. Xilanh thuỷ lực tác động hai phía 


Có thể khắc phục nhược điểm đó bằng cách tạo cho cẩn piston 
nằm về cả hai phía. Tuy nhiên như thế khi chuyển động cần piston lại 
chiếm nhiều không gian hơn. Trong trường hợp này: 


F=S(m-p;) (11.22) 


Đề lập mô hình toán cho quá trình hoạt động của xilanh thuỷ lực 
tác động hai phía và đối xứng về hình học, ký hiệu x là toạ độ chuyển 
dịch của piston tính từ vị trí trung bình, v - vận tốc, 2h - hành trình. Trên 
cơ sở các biểu thức đã nhận được ở trên ta viết: 


Phương trình lưu lượng, từ (1 1.9): 


S(h +x) đp, 
l = ¬ = .2 

B dt q -q,~q. (11.23) | 
S(h—x) đp; 

=q„+q- 11, 

B dị 4,+q-4; (11.24) 

Phương trình năng lượng tổn thất, từ (11.5) và (1 1.6): 

Khi chảy tầng: p, - p; = Rq, (11.25) 
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Khi chảy rối: p,-p; =rd? (11.26) 
Từ (11.11)tacó: — q,=Sv (11.27) 
. : ¬ 
Phương trình chuyên dịch một khối lượng m với gia tốc Sắc có lực 
cản tác dụng F, và hệ số nhớt động lực @ như sau: 
đv : 
m(—)=F-gv-F, (1128 
PP ) Ọ ) 
Trên cơ sở (11.22) đến (11.28) dẫn đến hệ phương trình vi phân 
mô tả quan hệ giữa các biến số về trạng thái bên trong: p¡, p;, u, X với các 
thông số bên ngoài: q,, q›, F:: 


Sh+x)dp _ _Ppị Đ; 


—9v+ 
B dư R s 
Sh~X)đP: _ PP ay 
B dđ R  R 
dv (11.29) 
ĐI co = 5D, TS; ~@v—F, 
dx 
Xà j 
dị 


V/ À\ \ 


W2 


Ú _N /) 
sẽ 
C?22U/2C 


sà 


Sàn 


ki 


Hình 11.31. Xilanh quay 
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Để thực hiện các chuyển dịch góc trong tay máy có thể dùng các 
loại xilanh tnh tiến. Ví dụ, dùng xilanh thuỷ lực gắn liền với cơ cấu 
thanh răng bánh răng hoặc là gắn liền với cơ cấu tay quay - thanh truyền 
hoặc là dùng hai piston chuyển động song song. 


Trên hình (11.31) là các xi lanh quay. Phương án hình (11.314) có 
rnột cánh gạt tĩnh gắn với hộp hình trụ và một cánh gạt gắn với trục ra. 
Còn phương án (11.31b) có hai cánh gạt tính và hai cánh gạt động. Trong 
xilanh này thì góc quay nhỏ hơn một nửa nhưng mômen tạo ra lớn gấp 
đôi khi có cùng kích thức bên ngoài như xi]anh hình (I 1.31a). 

Tương tự như đã làm đối với xilanh tịnh tiến ta lập mô hình toán 
đối với xilanh quay thuỷ lực. 


086205, TP00 T12 0. TÔ. 
B đi R ñR = 


C(6, - ổ) 8) đụ; "...... 


+Cø@~— 
B_ dở. R R „ 
đ 1.30 
J” =Cp, ~Cp, ~p—M, vn, 
di 
d0 - 
; 


với Ô - góc quay của xilanh. 2Ô, - góc hành trình, œ - vận tốc góc, ] - 
mômen quán tính, M, - mômen cản, C - thể tích chất lỏng khi xilanh quay 
đi 1 rađian. Như vậy thể tích trung bình của chất lỏng là C,. 


Để thực hiện chuyển động mà không hạn chế phạm vi góc quay 
có thể dùng một số loại môtơ thuỷ lực có tác động thuận nghịch vừa là 
bơm, vừa là môtơ. Môỏtơ thuỷ lực chia làm hai loại: chiều trục và hướng 
kính. 


—} bay—————| 


Sanh : 


Hình 11.32. Môtơ thuỷ lực chiều trục (hãng Rexroth-Sigmal. 
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Trên hình 10.32 là một loại môtơ thuỷ lực chiều trục có đĩa 
nghiêng của hãng REXROTH - SIGMA. Trục quay nối liền với blôc các 
xilanh. Thường có 7 hoặc 9 lỗ xilanh dọc theo chiêm trục nằm dưới các 
góc đều nhau trong thân blôc đó. Các piston chuyển động trong các 
xilanh có tận cùng là các khớp cầu. Các khớp cầu này nằm trong các gối 
tì. Chúng tạo với một đĩa nghiêng thành các ổ đỡ thủy nh nhờ các lỗ 
khoan dân dầu xuyên qua các chốt tỳ. Toàn bộ blôc các xilanh và đĩa 
nghiêng đều nằm trong một thân hộp chứa các gối tựa của trục quay. 


Áp lực của dầu tác dụng lên piston hướng dọc trục được phân ra 
hai thành phần: một thành phần thẳng góc với mặt đĩa nghiêng và thành 
phần kia theo phương tiếp tuyến. Nhờ vậy mà tạo ra mômen quay. Nếu 
thay đổi góc nghiêng giữa mật đĩa nghiêng với trục quay sẽ thay đổi quy 
luật biến thiên thể tích dầu chứa trong các xilanh ứng với một vòng quay 
của trục. 


22⁄2 


Hình 10.33. Marơ thuủ lực có biêc xanh nghiêng một góc với trục quap. 


Trên hình 11.33 là một loại môtơ thuỷ lực với thân blôc các xilanh 
đặt nghiêng với trục quay. Ở đây các đầu piston nằm trong các khớp cầu 
của đĩa nối vuông góc với trục quay. Thân biôc các xilanh quay quanh 
trục định hướng và tì khít lên một mặt cầu (mặt phân phối) gia công rất 
chính xác, để bịt hoặc thông các lỗ dẫn dầu với các xilanh. Nếu thay đổi 
góc nghiêng giữa trục tâm thân blôc các xilanh và trục quay, sẽ thay đổi 
quy luật biến thiên thể tích chứa đầu của các xilanh. 


Trên hình 11.34 là loại môtơ thuỷ lực hướng kính của Hãng 
SAMM. Trong thân của Rôto thường chứa 7 hoặc 9 xilanh, trục của 
chúng đều hướng tâm. Các xilanh được thông với đường dầu áp suất cao 
hoặc áp suất thấp nhờ vị trí tương đối của mặt phân phối được gia công 
rất chỉnh xác. Phần đầu của các piston chuyển động trong các xilanh đó 
đều có các con lăn. Chúng tỳ vào các biên dạng cam phía trong của stato. 
Biên dạng có nhiều đoạn khác nhau: ở đoạn ø xilanh thông với đường dầu 
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áp suất cao đẩy piston tác dụng lên con lăn F. Hợp lực này với phan lực 
R của biên đang cam tác dụng lên con lăn tạo ra lực vòng T. 


Hình 11.34. Mô tơ thuỦ lực hướng kính (hãng Samm) 


Chính do lực T này mà có mômen quay của môtơ. Qua đoạn biên 
đạng chuyển tiếp b rồi tới đoạn c. Lúc này xilanh được thông với đường 
đầu áp suất thấp. Tiếp theo là đoạn đ chuyển tiếp trung gian và cứ thế 
chuyển sang một chu kì mới lặp lại. Số lượng xilanh và số chu kì thay đổi 
của biên dạng phải chọn sao cho ở bất kì vị trí tương đối nào giữa rồto và 
stato đều có ít nhất một con lăn tiếp giáp ở biên dạng ứ để đảm bảo cho 
rôto quay liên tục. 


11.3.3. Thiết bị điều khiển thuỷ lực 
Đặc tính của van phân phối kiểu con trượi 


Trong Kĩ thuật tay máy thường gặp loại van phân phối thuỷ lực 
kiểu con trượt như trên hình 1.35. 


“ * ”?% 
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Hình 11.35. Sơ đồ uan phân phối kiểu con trượt. 


306 


Tuỳ vị trí của còn trượi dịch chuyển trong thân van mà lưu lượng 
đt thông vào các buông được nhiều hay ít. Vì vậy cần chú ý đến quan hệ 
hình học giữa con trượt và thân van ở vùng các cửa đường dẫn. Ví dụ, để 
khảo sát phía cửa bên phải của van phân phối trên hình 11.35 sẽ xét ba 
trường hợp sau: : 


Hinh 11.36 
a) Con trượt khe uừa khít cửa ua; b) Đường đặc tính q(u). 
1i ường hợp Í (hình LI.36a) - con trượt che vừa cửa van, 


Gọi u là thông số biểu thị độ chuyển dịch của con van trượt và e là 
chiều rộng rãnh trên thân van. 


Nếu e <u thì lưu lượng qua cửa đạt giá trị lớn nhất q = qự: 
Qụ = KejP, —p, =Öc 
với  p„p,- ấp suất ở buồng xilanh; 
K vàG - các hệ số biến đổi. 
Nếu 0< u0<e ta có: 
q = Ku/2(p, -p) =Gu 
với  p=0,5(p, +p,) - áp lực trong buồng van. 


Nếu -e <u <0 ta có: 


q=Ku./2(p—-p,) ->q <Gu 


Nếu u < -e thì q= “đụ - 
Từ đó xây đựng đường đặc tính q(u), hình 1! .36b. 
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Hình 11.37. a) Con trượt che cửa oan có dư; b) Đường đặc tính q(u) 


Trường hợp 2 (hình 1Í.37) - con trượt che cửa van có dư (lượng dư 
là 2-). lúc này ta có: 


l)e+r<u —> q=q„=Ge; 
2)r<u<e+r _—> q=G@u -r); 
3)-r<€u< +r > q=0: 
4)-e-r<un<-r _> q=6(u+r); 
3)u<-e-r —>_ q=-q„=-Œc. 


Đường đặc tính q(u) của trường hợp này biếu thị trên hình 
(11:37b). 


Hình 11.38. ø) Con trượt che chưa khít cửa uan 
b) Đường dặc tính q(u). 
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Trường hợp 3 (hình 1I.3§a) - con trượt che chưa khít cửa van 
(lượng thiếu - 2đ). Nếu BỌI đ là phản lưu lượng từ cửa áp suất cao p, đến 
buồng đang có áp suất p và pˆ là phần lưu lượng từ buồng áp suất p đến 
cửa áp suất thấp bộ thì lưu lượng hữu dụng q = q - q" và lưu lượng tổn 
thất q” sẽ bằng q” hoặc q' tuỳ thuộc đấu của q. Ta xét: 


l)e-d<u -> q°=dự q"=0 q=ẽq¿ q=0 
2›d<u<c-d_  G(u+d) q=0 q=d q =0 
3)-d su<+d > q=G(u+d) q" =-Gúu - đ) 

q= 2Gu, qz0 
4)-e+d<u<-d >q=0Ô q"= -G@ - đ) 

q =G@u - đ), q =0 
5)u<-e+d — q =0, q”=+d. d=-qụ, TT 


Từ đó chúng ta có đường đặc tính q(u) của trường hợp này như 
hình 11.38b. 

Hệ thống trợ động thuỷ lực 

Hệ thống trợ động thuỷ lực (the hydraulic servo system) có đặc 
điểm là cơ cấu chấp hành (đầu ra) tái hiện các quy luật chuyển động từ cơ 
cấu điều khiển (đầu vào), đồng thời luôn luôn giữ liên hệ phản hồi giữa 
đầu ra và đầu vào. 


Hình 11.39. Hệ thống bám thu lực 
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Trên hình 11.39 là sơ đồ hệ thống bám thuy lực gôm van phân 
phối con trượt và xilanh động. Ở đây thân van con trượi gắn liên với thân 
xIlanh động tạo nên một mốt liên hệ ngược cân thiết. Khi con trượt ở vị trí 
trung gian, đầu ép thông qua các khe có tiết diện như nhau và do vậy áp 
lực trong 2 buồng xilanh cũng bàng nhau. Khi dịch con trượt vẻ phía bên 
này hoặc bên kia so với vị trí trung gian thì áp lực trcrg 2 buồng sẽ chênh 
lệch nhau làm cho thân xilanh và thân van con trượt đều dịch chuyển. Các 
thông số chuyên dịch được xác định bơi ty lệ diện tích các khe dầu. Ty lệ 
này do vị trí con trượt (so với vị trí trung gian) định đoat và bán thân vị trí 
con trượt lại phụ thuộc vào tín hiệu điều khiển, Tín hiệu điều khiên có thể 
là tín hiệu điện hoặc tín hiệu cơ v... v... và thường hơn là tín hiệu điện . 
Vấn đề là độ chính xác định lượng giữa tín hiệu điện và ty lệ điện tích các 
khe dầu vào xilanh. 

Vì thế xuất hiện nhiều phương pháp cải tiến khác nhau. Trong đó 
van trợ động thuỷ lực (the hydraulic servo valve) được quan tâm đặc biệt. 

Trên hình 11.40 giới thiệu sơ đồ nguyên lý hoạt động của loại van 
trợ động thuy lực MOOG, là sản phẩm của một hàng nổi tiếng ở nhiều 
nước. 


4⁄4 


Si 
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Hình 11.40. Ven trợ động thuỷ lực MOOG. 


Như trên hình 1 I.40a van trợ động thuỷ lực gồm 3 hàn chính. 
Phần thứ nhất có các cực nam châm l, lõi 2 và cuộn cảm 3. Phần thứ hai 
có ống mỏng 4 nối giữa lõi 2 và lưỡi gà 5. Lưỡi gà 5 cùng vớt vòi phun 9 
là một cặp “vòi phun - màng chắn”. Phần thứ ba chủ yếu gồm con trượt và 
cã: hộ phận liên quan. 
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Khi có tín hiệu điện điều khiển lõi 2 quay nghiêng đi, làm biến 
đạng ống mỏng 4 và di chuyến vị trí của lưỡi gà 5, hình 10.40b. lúc này 
lõi 2 quay nghiêng vẻ phía bên phải. làm lưỡi gà chặn vòi phun phía bên 
phải. Do vậy áp suất điều khiển tầng lên, kéo theo đẩy con trượt về phía 
bên trái. Con trượt dí chuyển nên thay đổi diện tích khe cửa làm áp sue† 
truyện lực tăng lên và tác động đến xilanh thực hiện truyền tải, ví dụ, làm 
chuyển dịch khớp động tay máy. Khi con trượt di chuyển về phía trái 
cũng gạt lưỡi gà Š như một lö xo phản hồi. về phía trái. Do vậy tạo nên 
một mômen tác động lên tín hiệu điều khiển đưa vào. Khi cân bằng hai 
mômen này thì con trượt sẽ nằm yên ở vị trí mong muốn của người điều 
khiển. Nếu piữ được lưu lượng dầu ổn định thì vị trí con trượt cũng sẽ ốn 
định. 


Hệ thống trợ động thuỷ lực được dùng rộng rãi trong nhiều lĩnh 
vực kĩ thuật, nhất là trong kĩ thuật tự động hoá các quá trình công nghệ. 
Liên hệ phản hồi giữa đầu ra và dầu vào của hệ có thể là liên hệ theo ví 
trí, theo vận tốc chuyển động hoặc theo lực tải. Thường dùng hơn cả là 
lién hé phản hồi theo vị trí, vì nhờ liên hệ này có thể đạt được độ chính 
xác cao khi tái biện quy luật điều khiển và độ ổn định chuyển động. 


11.4. TRUYỀN DẪN ĐỘNG THUY - KHÍ KẾT HỢP 


Xu hướng tạo ra các hệ truyền dẫn hỗn hợp nhằm phát huy các ưu 
điểm và bù trừ các nhược điểm của các loại truyền dân riêng lẻ. 


Hình 11.41. Sơ đồ hệ truyền dẫn thuỷ lực - khí nén 


. Trên hình 11.41 là sơ đồ hệ truyền dẫn hỗn hợp thuỷ lực -khí nén. 
XHanh thuỷ lực hoại động song song với xilanh khí nén để đảm bảo việc 
hiệu chỉnh vận tốc và vị trí của khâu chấp hành của tay máy. 


Khí nén từ nguồn vào một trong hai buồng của xilanh khí nén (1) 
qua van phân phối (7) và làm cho piston chuyển địch với vận tốc được 
hiệu chính bàng van tiết lưu thuỷ lực (3). Khi đó van phân phối (5) nằm ở 
phía bên phải để thông với cả hai buồng của xilanh thuỷ lực. Van phân 
phối (5) có thể đóng vai trò như một khoá thuỷ lực để cố định vị trí của 
tay máy. Với tính chất tương tự như ở phần tử (3), nếu dùng van tiết lưu 
điều khiển bằng điện thì có thể đễ thực hiện điều khiến vị trí theo tín 
hiệu phản hồi. 

Trong kỹ thuật robot công nghiệp còn ứng dụng các truyền đân 
điện - khí với mục đích tương tự như trên, nhưng thay truyền san thuỷ lực 
bằng truyền dẫn điện. 


Trong sơ đồ hệ truyền dân thuy - khí trên hình I 1.42 có đặt thêm 
mớt xilanh khí nén phu (1) trước xi lanh thuỷ lực (2) cốt để tránh phải 
dùng nguồn thuỷ lực. Khí nén vào một buồng của xilanh {(l) tạo áp lực 
trong buồng xilanh (2) đẩy dầu làm piston xilanh chấp hành (3) của tay 
máy chuyển dịch theo một phía và sẽ đổi chiều khi piston của xilanh (1) 
di về phía ngược lại. 


Hình 11.42. Sơ để hệ truyền dẫn thuỷ - khi uới xilanh khí nén phụ 


Truyền dẫn hỗn hợp điện - thuỷ lực được dùng tương đối nhiều. 
Trong đó đầu vào dùng truyền động điện công suất bé, còn đầu ra là 
truyền động thuỷ lực. Truyền động điện tạo ra tín hiệu dịch chuyển cho 
hệ khuyếch đại thuỷ lực, có thể hình thành hệ trợ động kín hoặc hở dùng 
động cơ bước. 
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CHƯƠNG XII 


THIẾT BỊ CẢM BIẾN 


13.1. GIỚI THIỆU CHUNG. 


Các thiết bị cảm biến (sensors) trang bị cho robot để thực hiện 
việc nhận biết và biến đổi thông tin về hoạt động của bản thân robot và 
của môi trường, đối tượng mà robot phục vụ. Theo phạm vị ứng dụng các 
loại cảm biến dùng trong kỹ thuật robot, có thể phân ra 2 loại: 


- Cảm biến nội tín hiệu (intemal sensors) đảm bảo thông tin về vị 
trí, về vận tốc, về lực tác động trong các bộ phận quan trọng của robot. 
Các thông tin này là những tín hiệu phản hồi phục vụ cho việc điều chỉnh 
tự động các hơạt động của robot. 


- Cam biến ngoại tín hiệu (cxternal sensors) cung cấp thông tin về 
đối tác và môi trường làm việc, phục vụ cho việc nhận đạng các vát xung 
quanh, thực hiện đi chuyển hoặc thao tác trong không gian làm việc, Để 
làm được các việc đó, cần có các loại cảm biến tín hiệu xa, cảm biến tín 
hiệu gần, cảm biến “xúc giác” và cảm biến “thị giác” v.v... 

Để thực hiện nhiệm vụ cúa các loại cảm biến nội tín hiệu và ngoại 
tín hiệu nói trên có thể dùng nhiều kiểu cảm biến thông dụng hoặc 
chuyên dụng. Các kiểu cảm biến thông dụng không chỉ dùng cho kỹ thuật 
robot mà còn dùng nhiều trong các thiết bị kỹ thuật khác. Có nhiều tài 
liệu kỹ thuật vẻ các kiểu cảm biến này. 

Tuỳ theo các đạng tín hieu cần nhận biết mà phân thành các kiểu 
cản biến khác nhau: cảm biến lực, vận tốc, pla tốc, vị trí, ấp suất, lưu 
lượng, nhiệt độ v.v. 


Tuỳ theo cách thức nhận tín hiệu lại phân ra các Xiẻu khác nhau, 
Ví dụ, cũng là cảm biến vị trí nhưng có kiểu cảm ứng, kiểu điện dụng, 
kiểu điện trở. kiểu điện quang v.v. 

Dưới đây giới thiệu một số kiểu cảm biến thường dùng trong kỹ 
thuật robot. 
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11.2. CẢM BIẾN VỊ TRÍ, VẬN TỐC VẢ GIÁ TỐC. 
12.2.1. Cảm biến vị trí kiểu chiết áp. 


Đây là loại cảm biến vị trí kiểu điện trở thay đổi theo nguyên lý 
chiết áp rất quen biết. Nguyên lý hoạt động của chiết áp được mô tả trên 
sơ đề mạch cơ bản (hình 11.1a) hoặc là sơ đồ bố trí mạch thực tế (hình 
12.1b) và thể hiện bằng quan hệ sau: 


ve — (12.1) 


Cá trị điện áp đầu vào v sẽ thay đổi từ v = 0 khí r = Ö đến gia tr] 
bảng điện áp cáp vào V khi r = R. Nếu gắn sự chuyển dịch vị trí cần đo 
với đầu trượt r của chiết áp thì thông qua giá trị điện áp v sẽ biến đổi tỷ lệ 
thành giá trị chuyển dịch vị trí cần do. 


2 


Hình 12.1. Sơ dồ mạch chiết áp 


Kiểu cảm biến này hay được dùng để xác định độ dịch chuyển 
góc của các trục quay. Người ta lại có thể dùng nó để xác định vận tốc 
góc bảng cách vi phân bậc nhất và xác định gia tốc bằng cách vì phân bậc 
2 đại lượng dịch chuyển. 


Kiểu cảm biển chiết áp được dùng rất rộng rãi trước hết là vì giá 
thành thấp, độ bền sử dụng tương đối cao (nhờ áp dụng công nghệ vật 
liệu chất đẻo cải tiến bộ phận đầu trượt r nên có thể đạt tới bộ bền I0” chu 
kỳ), độ tuyến tính khá cao v.v. Tuy nhiên lại có các hạn chế như làm việc ' 
với tốc độ thấp (10 vòng/ phút đối với trường hợp quay và Ì m/s đối với 
trường hợp tịnh tiến), chất lượng chỗ tiếp xúc của bộ phận trượt có thể 
gây nhiều và giảm độ nhạy, 
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12 2.2. Vận tốc kế. 


Phạm vi sử dụng vận tốc kế (tachometers) và gia tốc kế 
(accclerometers) ngày nay trở nên thu hẹp. mà thông dụng hơn là xác 
định theo số gia của các thông tin cảm biến vị trí bằng kỹ thuật số hay kỹ 
thuật vi mạch. Cách làm đó đạt được độ chính xác cao hơn và ngày càng 
rẻ hơn. 

Thường dùng các thiết bị sau để thực hiện chức năng của vận tộc 
kế: 

- Phát tốc (tachogenerator) dùng một chiều 

Khi stato được kích từ tạo nên từ thông thì trong các cuộn cảm 
trên roto có suất điện động từ cảm với giá trị trung bình tỷ lệ với góc quay 
của rotOo. 

- Phát tốc không đồng bộ dòng xoay chiều 

Khi dòng điện xoay chiều chạy qua cuộn dây sơ cấp của stato thì 
điện áp trên các đầu dây cuộn thứ cấp của stato sẽ có cùng tần số, biên độ 
và tý lệ thuận với vận tốc góc của roto. 

- Phát tốc đồng bộ 

Nam châm vĩnh cứu trên stato gây dòng điện cảm trong cuộn dây 
của stato. Tần số và giá trị điện áp của nó tỷ lệ thuận với vận tốc của roto. 

- Phát tốc xung 

Đĩa quay có khe rãnh đặt trước nguồn séng tạo ra các xung có tần 
sŠ ¡ÿ lệ với vận tốc gốc quay. 

12.2.3 Cảm biến vị trí kiểu biến áp 

Cảm biển kiểu này hoạt động theo nguyêt: lý của một biến áp sai 
động (differential transfomer): lõi từ chuyển động tương đối với 2 cuộn 
dây cố định và làm việc thay đổi dòng cảm ứng giữa chúng. 

Trên hình 12.2 là sơ đồ biến áp xoay. Roto có một cuộn đây, còn 
stato có một hoặc một vài cuộn dây cảm ứng đồng bộ. 


Gia thiết cấp vào cuộn dây của roto một điện áp: 


u, = Ù sinmt (12.2) 
thì trong các cuộn đây trên stato sẽ xuất hiện các điện áp cảm ứng: 
u,¡ = KU, cos r sin (œtf + tp) q 243) 
u,; = KU, cos r sin (@t + @) (124) 


trong đó: 
K - hệ số biến áp 
 - độ lệch pha 


"Từ các công thức trên có 
thể xác định được góc r. 

Tuy nhiên sự biến động 
biên độ điện áp làm giảm độ 
chính xác tính toán. Bởi thế 
người ta sử dung phương pháp 
giải điều biến đồng bộ 
(synchronous demodulation) 
trên cơ sở đối chiếu với tín hiệu 
chuẩn (không trùng với điện áp Hình 12.2. Sơ đề biến áp xoay 
cấp vào roto). Trong trường hợp 
biến ấp xoay nhiều cực (không phải 2 cực như hình 12.2) thì độ chính xác 
có thể tăng lên. Người ta thường sử dụng kết hợp bộ biến áp xoay với bộ 
biến đổi điện tử số để nâng cao độ chính xác. 

Cảm biến vị trí kiểu biến áp 
làm việc tin cậy. chính xác và phù hợp 
với dải rộng vận tốc quay. Vì không 
dùng đến vòng tiếp điểm như kiểu 
chiết áp nên chúng có thể làm việc với 
vận tốc cao (đến 9000 vòng/phúu). 
Tuy nhiên lại đòi hỏi độ chính xác 
cao về chế tao và lắp ráp, nẻn giá ~= 
thành cũng cao hơn nhiều. 


ĐhÕn do đu rở 


Tương tự, đối với trường hợp 
tịnh tiến có cảm biến vị trí kiểu biến 
áp sai động thay đổi tuyến tính LVDT 


(Linear Variable Differemtial : : : 
Transformer), như trên hình 12.3. Bao Hình 12.3. Sơ đồ cảm biến 
bọc xung quanh lõi từ là một cuộn uị trí kiêu LVDT 


dây sơ cấp và hai cuộn dây thứ cấp giống hệt nhau. Khi dịch chuyển lõi 
từ độ từ cảm tương hỗ giữa cuộn dây sơ cấp và các cuộn dây thứ cấp sẽ 
biến đổi tuyến tính theo độ dịch chuyển đó. 


12.2.4. Cảm biến điện từ. 


Trên hình 12.4. giới thiệu sơ đồ cảm biến điện từ (magnetic 
tachoineter) đo vận tốc hoặc độ dịch chuyển. Đầu đo 1 gồm cuộn dây 
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cảm 2 cuộn xung quanh lõi nam châm vĩnh cửu 3. Trên đầu trục quay 5 
gắn một đĩa có vấu 4. Khi trục quay, khoảng cách tương đối giữa đỉnh 
vấu hoặc chàn vấu so với vị trí lõi nam châm là khác nhau nên tạo ra sự 
thay đổi từ thông và gây ra xung điện đầu ra. 


Hình 12.4. Sơ đồ cảm biến điện từ 


12.2.5. Cảm biến điện quang 


Trên hình 12.5 giới thiệu sơ đồ cảm biến điện quang, gồm các đĩa 
(đối với trường hợp quay) hoặc các thước (đối với trường hợp rịnh tiến) có 
vạch tối sáng điều nhau. Một bên đặt nguồn sáng l, một bên đặt các 
quang trở 2. Do thay đổi vị trí tương đối của các phần di động so với phiẩn 
cố định nên tần số và lượng ánh sáng lọt vào quang trở cũng thay đổi. Tín 
hiệu qua bộ khuyếch đại 3 và tạo các xung, từ đó suy ra độ dịch chuvểến 
hoặc vận tốc. 


Hình 12.5. Sơ đồ cảm biến điện quang 


Thiết bị cảm biến mã hoá quang học là một kiểu cảm biến điện 
quang có nguyên lý làm việc như đã trình bày ở trên, những đế được đầu 
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tư và chế tạo chuyên dụng thành những thương phẩm quen biết với tên 
gọi là optical encođers. 


Thiết bị cảm biến mã hoá quang học là thiết bị biến dịch chuyển 
góc điển bình. Tín hiệu đầu ra của cảm biến loại này là tín hiệu số nên rất 
thuận tiện khi nối ghép với máy tính mà khòng cần thêm bộ chuyến đối 
A/Ð nào. 


Người ta phân ra 2 loại chính: cảm biến mã hoá giá trị tuyệt đối 
(absolute cncoders) và giá trị số gia (ncremental encoders). Loại thứ 2 
được dùng rộng rãi hơn vì giá thành thấp hơn. Nếu khi cần số liệu đọc ra 
là vận tốc thì chí dùng loại thứ 2 này. 


Cảm biển mã hoá tuyệt đối có bộ phận chính là đĩa trong suốt. 
Trên đó có từ 2 đến 30 đái đường riêng biệt chiều rộng như nhau và các 
đoạn sáng, tối tạo nên đĩa vạch chuẩn. Nguồn sáng sẽ chiếu lọt vào các 
cảm biến quang (thường dùng phototransistor hoặc photovoltaic). Do vậy 
cảm biến lần lượt tạo ra các xung như trên hình 12.6. 


Hình 12.6. Tín hiệu đầu ra dạng sóng củo thiết bị cảm biến mã hoá tuyệt đối 


Như trên hình 12.6, trên đĩa có 4 đải đường, với 16 vị trí chia hình 
tròn ra ¡6 hình rẻ quạt, góc đỉnh là 360/16 = 22,5”. Phía bên phải hình 
12.6 là các tín hiệu trong ¡1⁄4 vòng quay đã số hoá: số 0 ứng vớt khi quay 
qua đoạn tối, số 1 - khi quay qua đoạn sáng. Ở đây đã mã hoá theo hệ 
Gray Code. A là vị trí xuất phát để tính toán và cũng là nơi đặt hệ thống 
. cảm biến qưang và nguồn sáng L, còn W là bộ khuyếch đại và xử lý tín 
hiệu đạng sóng. 
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Cảm biến mã hoá số gia có cấu tạo đơn giản. Bộ phận chính là đĩa 
găn liền với trục quay, chế tạo từ loại thuỷ tình đặc biệt, có hệ số giãn nở 
nhiệt rất thấp, nên còn gọi là đĩa kính. Trên mặt đĩa kính được chia vạch 
đen trắng đều nhau. Đĩa kính có bán kính càng lớn thì khả năng chia độ 
càng cao. Khi đĩa kính quay, ánh sáng từ nguồn truyền qua những khoảng 

Ệ r 5 °® v Đá - SH _ ” X. ¿ mu 
trăng đến các quang trở đặt đối diện tạo ra những tín hiệu điện. Tín hiệu 
nhân được là tín hiệu thay đổi có quy luật, được cho qua bộ biến đổi đưa 


về đang tín hiệu hình sim hoặc tín hiệu dang xung cơ bản 
an"E : ẫ : , w 


Đề tạo ra sự thay đối quang thông khi cho luồng ánh sáng qua 
đĩa kính quay, người ta dùng một mặt chắn đứng yên có cấu tạo như hình 
12.7. Trên mặt chắn có 4 ô cửa sổ, mỗi ô có vạch đen trắng giống hệt trên 
đĩa kính, nhưng bố trí sao cho vạch khắc trên 4 ô cửa sổ này lệch pha 
nhaul/4 chu kỳ vạch khắc. 


Hình 11.7. Đĩa kính oà bố trí các ô cửa sổ trên mặt chắn 
Mỗi dịch chuyển góc quay của đĩa kính tạo ra sự thay đổi diện 


tích phần ánh sáng lọt qua, do vậy thay đổi quang thông dẫn tới sự thay 
đói tín hiệu điện. 
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Hình I?.8 cho thấy: 


- Tại cửa sổ A: các vạch trên cửa số che kín các khoảng trống trên 
đĩa kính nên ánh sáng không lọt qua. Lúc này điện trở là R..... 


- Tại cửa số B: các vạch trên cửa số trùng khít với các vạch trên 
đĩa kính và khơang trống được mở hết cỡ cho ánh sáng đi qua. Lúc này 
điện trở là R 


"1H * 


- Tại cửa sổ C: các vạch trên cửa số đi vào đến giữa khoảng trống 
trên đĩa kính nền diện tích phần ánh sáng lọt qua chỉ một nửa. Đây là vị 
trí trung hoà và có điện trở là R,=(R„„-Ru„)2. 


- Tại cửa sổ D: các vạch trên cửa số chớm vào nửa vạch khác tiếp 
theo. Lúc này, giống như cửa sổ C, diện tích cho ánh sáng đi qua chỉ còn 
một nửa và điện trở là Rụ. 


Cửa số À Của số B Cữa sổ C † Cửa số D 
Hình 12.8. V¡ trí tương đối ở các cửa số 


Như thế, khi mặt chắn quay tương đốt so với đĩa nửa chu kỳ thì: 
- Tại Á: Rự 
- Tại B: R„„„ tăng đến Rụ 
- Tại C: R„ tăng đến R„... 
- Tại D: Rạ giảm đến R, 
Và nửa chu kỳ tiếp theo: 
- Tạ: A : R„ giảm đến R 
¬ II B: Rạ tăng đến R„.. 
- Tại C: R„„„ giảm đến R, 
- Tại D: R„„ tăng đến R„ 


Quá trình này liên tục diễn ra tạo nên các tín hiệu chu kỳ. 


giảm đến Rụ 


mm 


min 
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“Ngày nay, trên cơ sở phát triển kỹ thuật vi xử lý người ta còn dùng 
một số phượng pháp chía nhỏ khoảng cách. Trong đó có phương pháp 
nhân xung và phương pháp nội suy điện tử dùng mạng điền trở thích hợp. 


12.3. CẢM BIẾN LỰC VÀ CẢM BIẾN XÚC GIÁC 
2.5.1. Cảm biến lực 


Câm biến lực chủ yếu dùng để nhận biết phản lực xuất hiện trong 
khi lắp ráp các chỉ tiết máy. Đôi khi cũng dùng để nhận tín hiệu lực trong 
các khớp động. Thường thường các cảm biến lực được lắp ở các khớp 
quay, khớp cổ tay hoặc trực tiếp trên bàn kẹp. Có nhiều phương pháp 
nhận biết lực dùng trong cơ cấu cảm biến. Ví dụ, trực tiếp suy ra từ sự 
biến thiên dòng điện ở động cơ một chiều lấp ở các khớp quay. Nhưng 
phổ biến là dùng phương pháp quen biết đo biến dạng dùng các tensomet. 
Chúng còn được gọi là các "tem biến dạng”, vì trông giống như những 
con tem nhỏ chứa bên trong một dây điện trở và được dán trên các thanh 
biên dạng. Dưới đây giới thiệu một kiểu cảm biến lực thường được lắp ở 
khớp quay cổ tay, chỗ nối với bàn kẹp và gọi tất là cảm biến lực chữ thập. 


Cảm biến lực chữ thập. 


Trên hình 12.9. mô tả một kiểu cảm biến lực khớp quay bàn kẹp, 
với bộ phận chủ yếu có hình chữ thập. Trên mỗi nhánh của hình chữ thập 
được đán 2 cặp tensomet. Qua những cầu đo, sẽ nhận biết được lực tác 
động lên mỗi nhánh chữ thập. 


Hình 1.9. Cảm biến lực chữ thập 
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Giả sử rằng ảnh hưởng qua lại giữa các tensomet là rất nhỏ, có thể 
bỏ qua. Như vậy từ các số đo của § cặp tensornet, bằng cách cộng hoặc 
trừ giữa chúng tuỳ theo các trường hợp cụ thể, có thể xác định được 3 
thành phản lực F ŒF,., F,, F,) và 3 thành phần mômem M (M,,M,, M,). 
Gọi chung F„ là một vectơ mở rộng bao gồm 6 thành phần nói trên và WV 
có thành phần là 8 số liệu đo được (W,, W,, W,, W,,W,, W, W¡, WI) 


E„ =R„W q25 
1ì Hạ 

với: Ry = = (12.6) 
ị Jẹp 


Các phần tử r„ # 0 của ma trận R¿ là các hệ số tương ứng đẻ biến 
đổi các số đo theo đúng thứ nguyên của chúng: W (von), FCN), M(Nm)- 


Theo bố trí các tensomet như trên hình 12.9 thì một số phần tử r, 
sẽ bằng O và ma trận (I6) sẽ như sau: 


0 0 „z0 0 0n 0 


mộ 0 0 0. m 0 0 0 

B.= 0 7 Hạ 0 ng Ö 0g 

P0 0 0m 0 0 0. rzgị 27 
0 my 0 0 0. r 0 0 


„0 m0 n 0 my 0 
Từ (12.5) và (12.7) có các thành phần của F„„„ ví dụ: 
F,=rạW, +rW;. (12.8) 
Biểu thức (12:8) hoàn toàn phù hợp với hình 12.9. 


Để xác định các hệ số r„ trong (12.7) người ta thường chuẩn mức 
hoá (calibration) kết hợp tính toán và thực nghiệm. Bản chât việc chuẩn 


hoá mức hoá ở đây là thiết lập một ma trận Re thoả mãn điều kiện sau: 


w= RE, 
(11) 


R¿. là ma trận 8x6. 
Nhân 2 vế (12.9) với (Ñ)T, ta có: 
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(Rÿ}' W=[(Ri'R?]!' E, (12.10) 
Từ đó: 

Fu=icR”!R:†!(R;JTW 1211) 
So sánh (11.5) và (11.11), ta có: 

R„~[(R;y! R;]!(Rị}, (1312) 
Ma trận R; được thiết lập trên cơ sở các công thức trên và các 

kết quả thực nghiệm khi cho trước các giá trị của Fụ. 

12.3.2. Cảm biến xúc giác 


Trong kỹ thuật người máy thường dùng các cảm biến xúc giác để 
nhận thông tin về sự tiếp xúc của bàn kẹp với đốt tượng. Những thông tin 
đó bao gồm vi trí, hình thù của đối tượng hoặc lực cần kẹp v.v. 


Có thể phân cảm biến xúc giác ra hai nhóm cơ bản: cảm biến có 
ngưỡng tín hiệu rời rạc và cảm biến có tín hiệu tương tự. Cảm biến xúc 
giác có ngưỡng tín hiệu rời rạc. Đây thực chất là những công tác tính vi 
được lắp đặt ở phía bên trong của các ngón bàn kẹp (hình 12.10) để cho 
biết thông tin đã có vật kẹp giữa các ngón chưa, cần kẹp vào vị trí nào của 
Vật V...V. : 


Hình 2.10. Cảm biến xúc giác kiểu công tắc lắp bên trong bản tay kẹp 
Các công tắc tinh vi có thể lấp đặt trên bề mặt tiến xúc phía trong 
của bàn kẹp. Ngoài ra còn có thể lắp đặt ở phía ngoài bàn kẹp hoặc ở các 
đầu dò của cơ cấu tay máy đề nhận biết thông tin về các chướng ngại vật 
trên đường di chuyển. 
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Hình 12.11. Cảm biến xúc giác dùng tín hiệu tương tự 


Cảm biến xúc giác dùng tín hiệu tương tự loại đơn giản nhất có sơ 
đồ như trên hình 12.11. Nó gồm một thanh tỳ vào vật nhờ lực lò xo. Lực 
ngang từ phía vật tác dụng vào thanh làm chuyển động đi một góc quay 
(ví dụ, bằng cơ cấu thanh răng - bánh răng). Gốc quay này tỷ lệ với lực 
ngang và được liên tục ghi đo bằng cơ cấu chiết áp. Ứng với độ cứng vững 
đã biết của lò xo, có thể xác định được lực theo độ dịch chuyển của góc 
để ghi đo. 

Trong những năm gần đây một vấn đề rất được chú ý là tạo ra các 
bề mặt xúc giác có khả năng thu nhận cùng một lúc một lượng lớn thông 
tin. Trên hình 12.12 là một ví dụ mình hoa. Phía bên trong các ngón của 


Hình 12.12. Bán kẹp có trang bị bề một xúc giác 
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bàn kẹp được gắn các mặt xúc giác (L). Các mặt phía bèn ngoài (2) của 
bàn kẹp có thể gắn cả các cảm biến tín hiệu rời rạc. 


Mặc dù mặt xúc giác thường là tổ hợp nhiều loại cảm biến riêng 
lẻ, nhưng một hướng có triển vọng là cùng dùng các tấm vật liệu bán dẫn, 
ví dụ, trên nền grafit có điện trở thay đổi theo áp lực. Sự thay đổi điện trở 
dễ đàng biến thành dao động tín hiệu điện. Biên độ của nó tỷ lệ với lực 
tác động lên bể mặt vật kẹp tại điểm tiếp xúc.Để tạo các mặt xúc giác mà 
đôi khi còn gọi là "lớp da nhân tạo" có thể có các phương pháp chủ yếu 
như trên hình 12.13. : 

Phương pháp ở hình †1.13a tạo ra các "cửa số" giữa khối vật liệu 
dẫn (1) nằm giữa thân vỏ (2) và hệ thống điện cực (3). Mỗi điện cực là 
một ô vuông "cửa sổ" tiếp nhận tín hiệu tại một điểm tiếp xúc với vẬI. 
Tuỳ thuộc vào áp lực lên vật liệu bán dẫn, dòng điện từ thân vỏ đến điện 
cực sẽ biến đối. Theo phương pháp ở hình 12.13b có các cặp điện cực (4) 
trên các tấm mạch điện (5) thì vật liệu dẫn nằm phía trên và cách điện với 
tấm này trừ các chỗ tiếp xúc với điện cực. Áp lực từ đối tượng làm thay 
đổi điện trở và nhờ các mạch điện tử biến đổi thành các tín hiệu khác 
nhau. 


Hình 12.13. Phương phúóp tạo các mặt xúc giác 


Trong các phương pháp hình 12.13c vật dẫn điện (1) đặt giữa 2 bộ 
điện cực ngang (X), đọc (Y) vuông gốc với nhau. Điểm chéo nhau giữa 
hai thanh điện cực X, Y có vật dẫn điện chen giữa thành một điểm nhạy 
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cảm. Bộ điện cực có lớp vỏ cao su (6) chuyển dịch tạo lực từ phía ngoài 
tác động lên mỗi điểm nhạy cảm làm thay đổi điện trở của vật đẫn và do 
vậy làm thầy đổi dòng điện. 

\124. CẢM BIẾN TÍN HIỆU GẦN VÀ TÍN HIỆU XA.` 

12:4.1. Cám biến tín hiệu gần. 

Trong kỹ thuật người máy thường dùng các cảm biến tín hiệu gần 
để xác định sự có mặt của đối tượng trong phạm vị không gian ngay sát 
bên chỗ thao tác để kẹp vật hoác di chuyển vòng qua chướng ngại, v.v... 
Thường sử dụng một số cảm biến chủ yếu sau đây: 


Cảm biến từ cảm dựa trên nguyên tác thay đổi độ từ cảm khi thay 
đổi cự \y giữa các vật thể kim loại và cảm biến. 


2 
Hình 12.14. Cảm biến từ cớm.. : 
a) Sơ đồ cấu tạo; b} Sơ đồ nguyên lú làm uiệc., 


Trên hình 12.1 là sơ đồ cấu tảo một kiểu cảm biến từ cảm. Nó 
gồm cuộn cảm (L) đặt sau nam châm vĩnh cửu (2) nằm trong thân vỏ (3) 
với phần cách điện (4) và đầu nối (5). Khi đặt cảm biến gắn với vật thể 
nhiễm từ thì các đường sức (6) sẽ thay đổi và khi có chuyển động tương 
đối của chúng trong từ trường thì dòng điện cảm trong cuộn dây sẽ thay 
đổi cường độ, biên độ và tân số tỷ lệ với mức thay đổi từ trường. 


Trên hình 13“15a. biểu điễn sự biến thiên theo thời gian t của điện 
thế V đầu ra cuộn cảm phụ thuộc vào vận tốc (1 - vận tốc cao, 2 - vận tốc 
thấp) dịch chuyển tương đối trong từ trường giữa cảm biến và đối tượng. 


Trên hình ÏZ.15b là quan hệ giữa biên độ A của điện thế và cự ly 
giữa cảm biến và đối tượng. Đề thị cho thấy khoảng cách càng xa nhau 
thì độ nhạy càng giảm và cảm biến chỉ có hiệu lực trong cự ly dưới lmm. 


Như vậy, để nhận được tín hiệu ra từ cảm biến loại này cần có sự 
chuyển động tương đối giữa cảm biến và đối tượng. Thông thường trong 
kỹ thuật người máy khi dùng cảm biến tín hiệu gần chỉ cần tín hiệu 
ngưỡng không liên tục. Có thể nhận được tín hiệu loại này bằng cách tích 
phân tín hiện ra. ˆ 
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Hình 12.15.a) Quan hệ giữa điện thế V uà thời gian, 1. oận tốc cao; 2. 
bận tốc thấp; b] Quan hệ giữa biên độ dòng điện ua khoảng cách từ cảm 
biến đến đối tượng. 


_ Cảm biến Hail dựa trên nguyên tắc của hiệu ứng Hall. Như trong 
vật lý đã biết hiệu ứng Hall liên hệ giữa điện thế hai đầu dây dẫn (hoặc 
bán dẫn) với từ trường. Nếu sử dụng cảm biến Hall này cùng với một nam 
châm vĩnh cứu, chúng sẽ nhận biết được sự có mặt của các vật thể nhiễm 
từ đặt sát bên cạnh. Như trên hình 12.16, khi có vật thể nhiễm từ sát bên 
canh thì từ lực (các mũi tên) chạy qua cảm biến Hall sẽ giảm đi rõ rệt. 
Nếu dùng chất bán đãn, ví dụ, silic chẳng hạn, thì có thể giảm nhỏ ới kích 
cỡ cửa cảm biến, tăng độ chính xác, tăng độ ổn định và nhất là có thể cấy 
trực tiếp trên cảm biến một mạch khuyếch đại. 


2 


Hình 12.16. ø) Cảm biến Hali; 
b) Cảm biến Hall uà uột nhiễm từ. 
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Cảm biến điện dung. Khác với các loại cảm biến từ cảm và cảm 
biến Hall là chỉ có thể nhận dạng các vật thể nhiễm từ, cảm biến điện 
dung phát hiện được tất cả các vật liệu rắn cũng như lỏng. Cảm biến này 
hoạt động theo nguyên tắc nhận biết các vật thể qua sự biến đổi của điện 
dung phụ thuộc vào khoảng cách tới vật đó. Có nhiều phương pháp nhận 
biết tín hiệu gần bằng các cảm biến điện dung. Đơn giản nhất là dùng bản 
tụ của cảm biến có thể rung khi điện dung vượt qua một giá trị ngưỡng 
nào đó. Dao động chuyển thành tín hiệu điện ở đầu ra. Cách phức tạp hơn 
là dùng phần tử điện dung luôn luôn có dao động hình sín. Khi điện dung 
thay đổi sẽ xuất hiện lệch pha. Độ lệch pha này tỷ lệ với điện dung cần 


nhận biết. 


Hình 12.17 là đồ thị về sự thay 
đổi điện dung AC phụ thuộc vào 
khoảng cách tới vật tự do. Khi khoảng 
cách này vượt quá vài mm thì độ nhạy 
của cảm biến giảm đi rõ rệt. Độ nhạy 
đó còn phụ thuộc vào vật liệu đo như 
trên hình 12.17 (đường cong số 1 đối 
với thép, số 2 - đối với pôlyme). 

Cam biến siêu ám. Các loại 
cảm biến giới thiệu ở trên đều phụ 
thuộc vào vật liệu của vật thể được đo. 
Mức độ phụ thuộc này có thể giảm đi 
nhiều khi dùng cảm biến siêu âm. 

Trên hình 13/18 mô tả cấu tạo 
một loại cảm biến siều âm dùng trong 
kỹ thuật người máy để nhận biết tín 
hiệu gần. Phân chủ yếu là bộ biến âm 


H008 mo 


Hình 12.17. Quan hệ giữa 
điện dung uà khoảng cách đến 
uật đo. 


dùng chất gốm điện (1) được bảo vệ bằng chất nhựa tổng hợp (2). Tiếp 
theo là phần giảm âm (3), cáp điện (4), vỏ kim loại (5) và vỏ bọc (6). 
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Hình 
12.18. 
Cảm biển 
siêu âm. 


Để tìm hiểu hoạt động của cảm biến siêu âm, cần phân tích cá< tín 
hiệu khi nhận cũng như khi truyền âm lượng. Dạng điển hình của các tín 
hiệu này cho trên hình 12.19. A là tín hiệu mang, B là các tín hiệu phát ra 
(1) và tín hiệu phản lại (2). Các xung C tách biệt tín hiệu truyền và tín 
hiệu nhận. Để phân biệt sự khác nhau giữa các xung, tương ứng với tín 
hiệu mang và tín hiệu phản lại, tạo ra tín hiệu D. Át là khoảng thời gian . 
đo nhỏ nhất, còn t, + t; là khoảng đo lớn nhất. Các khoảng thời gian này 

tương ứng với khoảng truyền sóng trong môi trường khi nhận được tín 
hiệu phản lại (lúc đó tín hiệu D có giá trị lớn nhất) sẽ hình thành tín hiệu 
E và sẽ có giá trị bằng không khi kết thúc xung tín hiệu A. Cuối cùng tín 
hiệu F sẽ hình thành khi xuất hiện xung tín hiệu E và sẽ là tín hiệu ra của 
cảm biến siêu âm hoạt động theo chế độ nhị phân. 


mm 


? 


rz 


Ề zø=. 
Hình 12.19. Tín hiệu siêu âm 


11.4.2. Cảm biến tín hiệu xa. 


Trong kỹ thuật người máy thường trang bị các cảm biến tín hiệu 
xa dể xác định khoảng cách từ chỗ lấp đặt cảm biến đến đối tượng. 
Khoảng cách có thể đo được theo thời gian phát đi và nhận lại tín hiệu xa 
dùng để dẫn đường cho người máy, giúp nó xác định các vị trí, hình thể 
của đối tượng và tìm cách vòng qua chướng ngại. Dưới đây giới thiệu một 
vài phương pháp nhận tín hiệu xa. 


- Đo tam giác là phương pháp đơn giản đo tín tiệu xa (hình 
12.20). Đối tượng được chiếu sáng băng một chùm tia của nguồn sáng 
(1), chùm tía này tác động vào bề mặt đối tượng và phản xạ vào đầu thu 
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(2). Như vậy có thể xác định khoảng cách D từ quan hệ kích thước của 


tam giác đo. hình 12.20. ˆ 
1x 
Hình 12.20. \ D:ag£ 
Phương pháp đo 
tam giác ? 
Ñ 
b 7 
4 
*———————~ 


- _ Đo khoảng cách theo thời gian truyền tín hiệu. 


+ Cách thứ nhất là xung ánh sáng chiếu tới và phản lại cùng dọc 
theo một đường. Khi đó khoảng cách tới bề mặt đối tượng được tính theo 
công thức D - c. T/2, với T - thời gian truyền tín hiệu, c - tốc độ ánh sáng. 
Hệ thống dùng xung lade có thể thụ được đồng thời tín hiệu hai chiều tỷ 
lệ với khoảng cách, nên tạo ra ảnh của đổi tượng. 


Hình 12.21. Đo khoảng cách theo thời gian truyền tín hiệu. 
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+ Cách thứ hai là dùng tín hiệu r!a lade. 

Trong cách thứ hai thay tín hiệu xung ánh sáng bằng tia lade liên 
tục và khoảng cách được tính toán qua độ lệch pha plữa tia tới và tra phản 
hồi (hình 12.21a). 


Giả thiết các tía lade với bước sóng 2. được tách hàng hai: một tia 
hướng về thiết bị đo pha (P) đặt cách khoảng L, còn tĩa kia chiếu vào bề 
mặt đối tượng đặt cách khoảng Ð. Như vậy quãng đường tống cộng chiếu 
tới và phản hồi từ bể mặt đối tượng D' = [L. + 2D. Nếu D =0 thì D =L và 
lúc đó hai tia tới thiết bị đo pha cùng một lúc. Hai tia này sẽ càng lệch 
pha nhau (hình L1.21b) nếu D càng tăng lên. Trong trường hợp này ta có: 

Đ= Để - À 
360 


VỚI 6 - độ lệch pha. 
Để tách biệt được hai tia, tức là để hai sóng không trùng nhau thì 
0 < 360” hoặc 2D <^. 


Từ hai biểu thức đối với D' suy ra: 
=_. 12.13) 


Vậy có thể xác định khoảng cách qua độ lệch pha (9) nếu đã biết 
bước sóng (^). 


+ Một phương pháp điển hình khác để đo khoảng cách theo thời 
gian truyền tín hiệu là phương pháp siêu âm. Ý tưởng cơ bản của phương 
pháp này cũng tương tự như trong phương pháp dùng tín hiệu xung lade. 


Tín hiệu siêu âm được truyền đi trong một khoảng thời gian ngắn 
và vận tốc truyền âm trong môi trường coi như đã biết. Qua việc tính toán 
quãng thời gian giữa tín hiệu truyền tới và tín hiệu phản hồi sẽ đánh giá 
được khoảng cách đến bề mặt đối tượng đo./. 


TÀI LIỆU THAM KHẢO 


. Andre P., Kauffmamn J.M., Lhote F., Tailard J. M, 


Les Robot- Constituants Technolopiques. 
Hermes Publishing, 1983. 


. CayerM. 


Vocabulaire de la robotique-Classification et Svteme meccanique. 
Les Publications du Québec. 1993, 


. CoIffetP.,Les rObots. 


T.2. Interacton avec  EnvIronnement. 
Herrnes Publishing, 1981 


.- Computational Kinematics. 


Kluwer Academric Pubhshers. 1993. 


. DenavH J., Hartenberg l. S., 


A Kmemattc Noration for Lower-Pair Mechanisms lãased on Miatrises. 
ASME Journal of AppHhed Mechanics, 1955 


. EuerÐ.M., 


Engineering Problem Solving with Matlab. 
Prentice - Hall, 1993 


. Fu.K.S., Gonzater R.C.. Lee C.S.G. 


Íftobotics: Control, Sensing. Vision and Intelligence. 
McGraw-Hil, 1987 


. Jutuard A., Betemps M., 


Les robots, 
Ecdlions Hermes, I9§8. 


- Mair G. 


Industrial Robotics. 
Prentice HalL, 1985 


10. Murray R., L¡ 2Z., Sastry 5., 


AÁ Mathematical Introduetion to Robotic Manipulation. 
CRC Press, 1989 


332 


11. PaulR.P., 


Modeling, Trajectory Caculation and Servoing of a Computer 
Controlled Arm. 


Palo Alto Calf, 1972. 
12. Paul R. P., 
Robot Manipulators: Mathematics, Programming and Control. 
The MTT Press - Cambridge, Massachusetts and London, England, 1981. 
: 13. Proceedings of the 7” Int. Symposium on Industrial Robois. 
_ Japan, Tokyo, 1977. 


14. Proceeding of the.5'" Word Congress of Theory of Machines and 
Mechanisma. 


Canada, Monrreal, 1979. 


15. Proceedings of the 10” International Symosium on Industrial Robots. 
lItaiy, Milan, 1980. 


16. Proceedings of Natonal Workshop "Robotics". 
New Delhi, Apnl, 1987 


17. Proceedings of the 9" World Congress on the Theory of Machines 
and Mechanisms. 


Milano, Italy, 1995 


18. Proceedings of the 10° World Congress on the Theory of Machines 
and Mechamisms. 


Oulu, Finland, 1999. 
19, Rohrs .E., Melsa J.L., Schultz D. G., 

Linear Control Sys(ems 

McGraw - Hi, 1993 
20. Roth B, 

Robotics, Applied Mechanics Reviews, VolL. 31, 1978 
21. Waldron K. J., Kmcel G. L., 


The relatlon between actuafor geornetry and mechanical effcienncy im 
robots. Preprints 4" CISM - IFToMM Symposium on Theory and 
Pract. of Manipul. 


Warsawa, 1981. 


22. Schilling R. 1., 
Fundamentals of Robotics, Analysis ®& Control. 
Prentice Hall, !990 

23. Snyder W.E., 
Industrial Robots: Computer Inierfacing and Control. 
Prentuce Haill Inc. New Jersey, 1985, 

24. Stadler W., 
Analytical Robotics and Mechatronics. 
McGraw-HII, 1995 

25. Stoll K., Deppert W., 
Pneumatic Confrol. 
Vogel Buchverlag Wurzburg, 1987. 

26. Stone H.W., 
Kinematic Modeling IdentiRicauon, and Control of Robotic 
Manipulators. 
Kluwer Academic publishers, 1987. 

27. Shimon Ÿ.Nof, 
Handhook of Industrial Robotics, 2” ed, 
John Wiley & Sons. Ine. 1909. 


28. Theory and Practice of Robots and Manipulators, Proceedings of 
RoManSy '84. The 5" CISM-IFToMM Symposium. 


Kogan Page, 1985. 
29. Young ]. E., 
Roboucs, 
London, 1980. 
30. Nguyễn Thiện Phúc, 
Tay máy - Người máy công nghiệp. 
Nhà xuất bản Khoa học và Kỹ thuật, 1983. 


334 


31. Nguyễn Thiện Phúc, Trương Sĩ Vịnh, : 
Tự động hoá thiết kế các sơ đồ môđun truyền dẫn khí nén. 
Tạp chí Cơ học, số 1, 1991. 
32. Nguyễn Thiện Phúc. 
Người máy công nghiệp và sản xuất linh hoạt. 
Nhà xuất bản Khoa học và Kỹ thuật. 1991, 
33. Nguyên Thiện Phúc, Trần Văn Cường. 
Tay máy công nghiệp TM-3B. 
Thông báo khoa học của các trường Đại học, 1995. 
34. Nguyễn Thiện Phúc, 
Người máy phỏng sinh và mô hình động học dạng tổng quát. 
Tạp chí Cơ học, số 4, 1995. 
35. Nguyễn Thiện Phúc, Trần Văn Cường, 


Về một phương pháp giải bài toán ngược động học khi tổng hợp quỹ 
đạo chuyển động của người máy. 


Tuyển tập các báo cáo khoa học Hội nghị Tự động hoá toàn quốc lần 
thứ II, 1996. 


36. Nguyễn Thiện Phúc, 
Điều khiển chuyển động robot hàn theo quỹ đạo định trước. 


Tuyển tập công trình Hội nghị Cơ học toàn quốc lần thứ VỊ. Hà nội, 
12/1997. 


37. Nguyễn Thiện Phúc, 


Ơn the problem of controlling rabot motions along a presribed 
trajec(ory. 


Preprints of the RESCCE “98. 
38. Nguyến Thiện Phúc, 


Phát triển phương pháp “các nhóm 3" để giải bài toán ngược động học 
khi tổng hợp quỹ đạo chuyển động của tay máy - người máy. 


Tuyền tập các báo cáo khoa học Hội nghị Cơ học máy Việt Nam, 
Hà Nội, 1999, 


335- 


39. Nguyễn Thiện Phúc, Phạm Phú Lý, Phạm Đăng Phước, Automatic 
Establishment of Kimematic, Modelling and Simulation of Robots. 
Proccedings of VỊ ASEM, 2000. 


40. Nguyễn Thiện Phúc, Nguyễn Văn Minh, Trần Ngọc Toản, 
Phạm Đăng Phước, 


Nghiên cứu thiết kế, chế tạo robot sơn phủ RSP - 406. 


Tuyển tập báo cáo khoa học Hội nghị Tự động hoá toàn quốc lần thứ 
IV, 4/2000. 


41. Nguyên Thiện Phúc, 


Kết quả nghiên cứu về robot công nghiệp tại Trung tâm nghiên cứu kỹ 
thuật tự động hoá, trường Đại học Bách khoa - Hà Nội. 


Tạp chí Tự động hoá ngày nay, số !5- 10/2001. 


42. Nguyễn Thiện Phúc, Trần Ngọc Toản, Trần Minh Nghĩa, 
Nguyễn Tiến Đức, 


Nghiên cứu thiết kế chế tạo robot SCA mini. 


Tuyến tập công trình khoa học Hội nghị khoa học toàn quốc về cơ kỹ 
thuật, Tập 2, 10/2001 


43. Phạm Đăng Phước 
Robot công nghiệp, 
Trường Đại học Kỹ thuật Đà Nắng, 1998, 
44. Apro6o,esckwi H. W. 
TeOpMøS M€XAHH3MOB H MAHIHH. 
M. Hayxa, 1975. 
45. BanakIuwH B. C., Baspop B. M., MưwTpodanos B. F. w J/Ip. 
À/1aTITMBHO€ VIID3BI€HWM€ CTAaKAMH, 
M. MatliwHocrpoHeHwe, 1973 
46. BeJIqHw„H ÏI. H, 
[lpoMkIbDiI€HHbi€ pOBOTMI W HX IDWM€Hte. 
M. MaiutwnocTpoenne, 1983. 
47. Ko6pnHcknl A. A., KoốpHHckHl A. E. 
MaHHTY78LWOHHBIE CHCT€MEI DOỐOTOB. 
M. Hayka, 1985. 


336 


48. KoakIpen EO. F., [Hiwdbpnh 41. A., 
COBDeM€HEBI€ TIDOMbIIIJI€HBIE DOỐOTHI: KäTATOT. 
M. MaiinHocTpoeHwe, 1984. 

49. Konopckul M. 3., Cnoyni A. B., 

OCHOBHI JHUHAaMMKH IDOMBILIJTCHHBIX pOGOTOB. 
M. Hayka. Ïn. pen. (bH3. MaT. 1T., [988. 
30. Konuun H,H, 
MexaHuKa MaIIHH: B 2-TOMAX.T.2. 
N.: Maiuirwa, 1962 
5I. KonunH H.H., Hryen TxenH CDyk. 


Oố OðPA3OBAHHM HOBBIX BHHTOBbIX IIOBEDXHOCT€H 
IIDMM€HMT€JIEHO K 3VỐWATBIM I€peradaM. TpymnI JTTIM, 321. 


Mamii., 1972. 
52. Kopennsacen À. W., CanaMaHnpa B. JI., Tbipec JI. H. 


OTID€N€JIEHH€ !ICJa CT€II€H€Ï CBOÕOJbI WCIïOTHWMT€/IbHOTO 
ODTAHaA IIDOMBILHHIETHOTO DOGOTa. 


ManiwHoBe€7eHHe. (985, No. 6. 

53. Hwnopg J[., [lapyttiep H., Bekapon B. 
AHATIM3 TOWHOCTU MâAHMTTV71MOHHBIX CMHCT€M, 
“TeopeTHWHa H TIDMJIOKHA MGXAHHKA“, 
BAH, Ma. 4, 1981. 

54. J]Hrnun Œ®. J1. 
Teopnws 3VỐuaTbiX 34!16TI€HMH. 
M. Hayka, 1968. 

55. Menwenen B. €., Jleckos A. F., KÔimteHo A. ©. 
CHCT€MbI YIIDABI€HW€ MAHWIIVJI1HIWOHHBIX DOBOTOB. 
M. Haya, 1979. 


337 


56. MuHkos K. 


HaKOw TIDOỐ/ICMH Hã M€XAaHMK8TA Hãâ MAHHITY7MHPAaIHH 
po6orn, j/lon. ĐO HC 84, BTV “Anren KbHwe8”. Pycc, 
1984. Š 


57. MexaHuKa TTDOMHIHUI€HHBIX pOðOToB: Vue6Ø. [locoõwe 1a 
BTy3oB: B 3 kH./Ilon. Pen. K. B. ®pouona, E. MH. 
Bopo6bena/ 


Bbicuiaa. Ilkona., 1989. 
3&§. HaxaneTaH E. I. 


KB4/IHM€TDMS H /Ia7HOCTHDpOBAHM€ poBOTOB // 
2KCTICDWMEHTATbHbI€ HCCJIEIOB3HMS M XHAâTHOCTMHDOBAHMe€ 
DOðOTOB. 


M. Hayka, I981. 
59, Hnku@opon C. O., CMo/IbHWKoOB B. A. 


OTITHMM3aUMS IapAM€TpOP TP€X3B€HHOTO MAHMTIYJ14TOpa // 
Po6oToTexHWKa. 


JTI.: JII1M, 1976. 
60. OxoiiiMcKnñli 71. E., Fony6ep IO. @®. 


MecxaHMKa H VIIDA4RBTICHH© ñBHXCNH€CM âBTOMATHHECKOBO 
HIäT210IH€FO âHI4p4T4. 


M.: Hayka, 1984. 
61. ®ponos K. B. 


MeTONbi COBDULII€CHCTROBAHHã MAIHWH HH COBDM€HHEIE 
IIDOỐ7I€MBIL_ MALIHHOR€H€HMSI. 


M. MaluinHocTpoeHwe, 1954. 
62. depHoycbko ©®, jI., Bonornwux H. H., I[panenkui B. T. 


MaHHTIVJ14IHOHHbIE DOỐOTHI: IHHAaMMKA, yHIDABJIEHH€, 
OITTMM3A11H1. 


M.: Hayka. Ïn. pen. (Đw.-MaT. IHT., 1989. 
63. KOpepwu E. H., AnernkKon bB. F., KopbIiko Ô. B., 
AHnpwanos lO. N., Kopomnen B. A., Capnmn B. F. 


V€TPOlCTBO ITPOMbIIIDI€HHbBIX DOOOTOB. 


338 


MỤC LỤC 


LỜI NÓI ĐẦU : 
CHƯƠNG I. GIỚI THIỆU CHUNG VỀ ROBOT CÔNG NGHIỆP 
1.1. Sự ra đời của robot công nghiệp 
.2.. Tình hình phát trien robot công nghiệp 
- lỨng đung rohor công nghiệp 
1.3.1. Mục trêu ứng dụng robot công nghiệp 
1.3.2. Các bước ứng dụng rooot công nghiệp 
I.3.3. Các [lĩnh vực ứng đụng robot công nghiệp 
L.4. Nói dung nghiên cứu phát triển robot công nghiệp 
1.4.1. Nhận xét về quá trình phát triển 
1.4.2. Cơ - tin - điện tử và robot công nghiệp 
1.4.3. Robót và hé thống sản xuất hình hoạt 
1.4.4. Robot song song 
I.4.5. Các xu thế ứng dụng robot trong tương lai 
.5. Tình hình tiếp cận và ứng đụng robot công nghiệp ở Việt Nam 
CHƯƠNG II. CÂU TRÚC VÀ PHÁN LOẠI ROBOT CÔNG NGHIỆP 
2.1. Các bộ phản cấu thành robot công nghiệp 
2.2. Bác tr do và các toa đó suy rộng 
2.3. Nhiêm vụ láp trình điều khiển robot 
2.4. 1ÏÍẻ toa độ và vùng làm viéc 
2.5. Chị uêu đánh giá và các thông số kỹ thuật 
2.6. Phân loại robot công nghiệp h : 
CHƯƠNG III. CÁC PHÉP BIỂN ĐÔI DỪNG MA TRẬN THUẦN NHẤT 
3.1. Biến đổi toa dộ đùng ma trân 
3.1.1. Vectơ điểm và toa độ thuần nhất 
3.1.2. Quay hệ tọa độ dùng ma trận 3x3 
3.1.3. Biến đối hệ tọa độ dùngma trận thuần nhất 
3.1.4. Ý nghĩa hình học của ma trận thuần nhất 
3.2. Tóm tắt nội dung cơ bản về ma trận 
3.2.1. Các định nghĩa 
3.2.2. Phép công. trừ ma trận 
3.2.3. Phép nhân ma trận 
3.2.4. Định thức ma trận 
3.2.5. “Rang” của ma trận 
3.2.6. Vết của ma trận 
3.2.7. Ma trận nghịch đáo 
3.2.8. Vi phân và tích phân ma trận 
3.3. Các phén biến đổi cơ bản 
3.3.1. Phếp biển đổi tịnh tiến 
3.3.2. Phép quay quanh các trục tọa độ 
3.3.3. Phép quay phức hợp 
3.3.4. Phép quay quanh các trục bất kỳ 
3.3.5. Phép quay theo góc Euler 
3.3.6. Phép quay Roll - Picht - Yaw (RPY) 
3.4. Các bài toán biến đổi ngược 


CHƯƠNG IV. 
SH» 
.2. 
4, 


CHƯỠNG V. 


CHƯỜNG VI. 
6. 


4 
4 


41. 


4 
4. 
4.6. 


tì 


6 


6. 
6. 


6. 
CHƯỠNG VII.LẬP TRÌNH QUY ĐAO CHUYỀN ĐỘNG VÀ MÔ PHÒNG “ 


7. 
7. 


1. 


=.“ 


-4. 
5. 


HH Nà 


L. 
2: 
3. 
4. 
SẺ 


l. 
2. 


3. 


3.4.1. Xác định góc quay và trục quay 

3.4.2. Nác định 3 góc Euler 

3.4.1. Xác định 3 góc PRY 

HỆ PHƯƠNG TRÌNH ĐỘNG HỌC ROBOT 

Đạt vấn đè 

Xác dinh trạng thái robot tại “điểm tác động cưới” 

Mô hình động học 

4.3.1. Ma trân quan hệ 

4.3.2. Rô thông số DH 

4.3.3. Thiết lập hệ tọa độ 

4.3.4. Mô hình biến đối 

+1.3.5, Phương trình dòng học 

Trình tự thiết lập hệ p phương tình động học của robot 
Mô bình toán chuyển đổi 

Hệ phương trình động học của các robot điển hình 
4.6.1. Hệ phương trình động học của các robot Stanford 
4.6.2. Hệ phương trình động học của các robot Elbow 
4.0.3. Hệ phương trình động học của các robot Adepi One 
4.0.4. Hệ phương trình động hoc của các robot Duma 
TÔNG HỢP CHUYỂN ĐỒNG ROBOT 

Nhiệm vụ tổng hợp chuến động của robot 

Bài toán động học ngược 

Các phương pháp giải bài toán động học ngược 

5.3.1. Trừng hợp robot n bậc tự do 

5.3.2. Giải bài toán động học ngược của robot Stanford 
5.3.3, Giải bài toán động học ngược của robot Elbow 
5,3,4. Phương pháp “cúc nhóm 3” 

ĐỘNG HIỌC ROBOT KHI DI CHUYỂN NHỎ 

Giới thiệu chúng 

Quán hệ dị chuyển nhỏ đối với hệ tọa độ cố định 
Quan hệ dị chuyển nhỏ giữa các hệ tọa độ với nhau 
TACORBIAN đối với cơ cấu tay máy 

Trình tự giải bài toán thuận khi đì chuyển nhö 


CÁC CHUYÊN DỘNG CỦA ROBOT 

Giới thiệu chúng về lấp trình cho robot 

À1õ lá các vài thể và nhiềm vụ 

7.2.1. Mô tả các vật thẻ 

2.2.2. Mô tả nhiệm vụ 

Hệ thống robot làm Việc với camera 

7.3.1. Biến đối chiếu hình 

7.3.2. Các phương trình cơ bản của hệ thống camera 
7,3,3. Phép chiếu hình lập thể 

7.4.4. Mô ta quan hệ robot và: caricra 


4. Thể hiện chương trình thao tác của robot 


vn 


. Chuyển động giữa các điểm tựa 


7.5.1, Đặt vấn để 
7.5.2, Mô tả quỹ đạo bảng Spline bác 3 
7.5.3. Lập trình quỹ đạo trong hệ tọa độ Đề -Các 


Trang 
7Ñ 
R3 
bÌU 
hh) 
b_) 
SÑ 
ỌI 
ĐỊ 
2 


ĐÀ 


- ỦA 


Òú 

97 

102 
103 
[0 
107 
115 
117 
122 
25 
123 
121 
121 
126 
130 
[3-{ 
l3o 
lão 
136 
139 
J42 
144 


lá% 
l 
lão 
lŠ6 
LS§ 
165 
1ó 
170 
172 
171 
175 
176 
176 
178 
1&ö 


7.5.4. Mô trí quỹ đạo qua các điểm tựa bằng đa thức bậc 3 có 
xét đến các han chế về động lực học 


CHƯƠNG VIILĐỒNG LỤC HỌC CỦA ROBOT 


7. 


Nhiễm ú và phương pháp phân tích động lực học của robot 
Vận tốc và gia lốc 

Đềng nàng tây niấy 

Thẻ nàng tay máy 


- Mô hình động lực học tay nuy 
- Các phương trình động lực học cơ cấu tay míy toàn khớp quy 


Đồng lực học cơ cấu tày máy 2 Khâu 


CHƯỜNG TX.ĐIẾU KHIỄN ROBOT 


U.1. 
St 


9.4, 


Đà, 
9,6. 
9.7, 
98. 
CHƯÖNG X. 
10.1. 
10.2. 


CHƯỚỐNG NI. 
HI.]. 


1]. 


lo 


Khát niềm chúng vẻ hệ điều khiến tự động 


- Phép biên đổi Ì.aplace 


9.2.1. Các cạp biển đối Laplace thường gAp 
9.3.2. Cúc tính chất của phép biến doi Ì.aplace 


.3.. Hầm truyền và sơ đồ câu lrúc của hệ điều khiển 


9.3.1. Định ngh1n 

9,3,3, Phương pháp biến đối sơ đồ cầu trúc 
Tám truyền tân so và đúc tính tấn số 

Hàm truyền chuyển động môi khớp động 
Điều Khiển chuyển đông mỗi khớp động 
Đánh giá đặc tính động lực của hệ điển khiển 
Điều khiển chuyển đồng robot nhiều bác tự đo 
TRUYÊN DẪN ĐÔNG ĐIỆN CƠ 

Giới thiện chứng 

"Truyền đần động cơ Khí 

10.2.1. Bộ truyền động bánh rang sóng 


10.3.3. T3ö truyền đồng vít đạt óc Dị 


-_ ng dụng truyền động điện 


10.3.1. Đông cơ điện mót chiêu 

103.2. Động cơ bước 

TRUYỀN DẪN ĐỘNG THỦY KHÍ 

Các khái niệm cơ bản 

Ì1.1.T. Các phương trình cơ bản ở chế độ làm việc bình ốn 
11.1.2. Các phương tình cơ bản ở chế độ làm việc chuyển tiếp 
Truyền dẫn động khí nén 

11.2.1. Đạc điểm chung 

11.2.2. Báng ký hiệu, tên gọi các phần tử và thiết bị khí nén 
1.2.3. Tính toán và chọn lựa xilanh khí nén 

11.2.4. Sơ đồ và phương pháp cấu tâãomchJ khí nén 

11.2.5. Các mạch khi nén cơ bản 


-- Truyền đân đồng thủy lực 


113.1, Đạc điểm chung 

11.3.2. Truyền dân động thủy lực 
11.3.3. Thiết bị điều khiến thủy lưc 
Truyền đẫn động thủy - khí kết hợp 


Trang 


10ầ 
LỌN 
198 
t99 
203 
3 
204 
2306 
2310 


341 


Trang 


CHƯỜNG NI THIẾT BỊ CẢM BIỂN gIẢO 
12.1, Gái thiểu chúng 3IA 
12.2. Cảm Điển vị rÍ, vận toc Và gia tốc 312. 
L2.2.1. Cảm biến vị trí kiểu chiết áp 3414 - 
12.2.2. Vận tốc kế 318 
12.2.3. Cảm biến vị trí Kiểu biến ấp 315 
12.2.1. Cám biến điện từ 4l6” 
12.2.5. Cảm biển điện quang 17 


13.3. Cam biển lực và cám biến xúc eUác 
3.3.1. Cam biện lực 
|3,3.2, Cảm biến xúc giác 
12.+. Cam biển tín hiệu gân và tín hiệu xa 
12.4.1, Cảm biến tín hiệU gảu 
12.4.2. Cảm biến tín hiểu xa 
TÀI LIỆU THAM KHẢO 
MỤC 1C 


“2 22 12222 LAI ưu lAU 
t2) T2 E2 s2 Ís> hờ To 
ca 


à © 
"`. 


vs 
A 
< 


„42 


ROBOT CÔNG NGHIỆP 


Tác giả: GS. TSKH. NGUYÊN THIỆN PHÚC 


Chịu trách nhiệm xuất bản: PGS.TS. TÔ ĐĂNG HẢI 
Biên tập và sửa chế bản: ,. NGUYÊN THỊ DIỆU THUÝ 
Trình bày và làm chế bản: NGUYỄN HÒA BÌNH 
Về hình: NGUYÊN THỊ HẠNH 


Vẻ bìa: HƯƠNG LAN 


NHÀ XUẤT BẢN KHOA HỌC VÀ KỸ THUẬT 
70 Trần Hưng Đạo, Hà Nội 


In 1.000 cuốn, khổ 16 x 24 cm tại Xưởng in Nhà xuất bản 
Thống kê. Giấy phép xuất bản số: 136-2006/CXB/331-06/KHKT. 
In xong và nộp lưu chiếu quý HÏ năm 2006. 


